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内 容 简 介 


本 书 全 面 介绍 了 智能 平衡 移动 机 器 人 的 应 用 平台 搭建 .平台 的 硬件 电路 数字 控制 系统 和 一 系列 开发 
移动 机 器 人 的 应 用 。, 这 些 应 用 由 浅 人 深 可 分 为 3 部 分 : 基础 外 设 应 用 、 基 于 机 器 人 外 设 的 进 阶 应 用 .基于 
机 器 人 外 设 的 综合 应 用 ,这 3 部 分 应 用 构成 了 读者 学 习 平 衡 移动 机 器 人 技术 的 阶梯 。 本 书 在 此 基础 上 着 
重 介绍 了 基于 模型 设计 的 开发 方法 .TMS320F28069 控制 芯片 的 特点 . 引 脚 与 功能 ,以 及 Embedded Coder 
Support Packages for Texa Instruments C2000 的 硬件 支持 包 。 综 合 来 看 ,读者 可 以 方便 快捷 地 实现 基础 应 
用 、 进 阶 应 用 和 综合 应 用 的 学 习 , 同 时 获得 更 多 关于 机 器 人 平台 硬件 .软件 等 多 个 方面 的 综合 知识 。 

本 书 适合 作为 高 等 院 校 机 械 、 电 气 、 自 动 化 以 及 计算 机 专业 高 年 级 本 科 生 和 研究 生 的 教材 ,同时 可 供 
对 于 基于 模型 的 开发 方法 感 兴趣 的 科研 人 员 、 从 事 MATLAB/Simulink 开发 的 研究 人 员 参 考 。 
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FOREWORD 


很 多 本 科 生 研究生 或 刚 入 行 的 工程 师 ,在 做 课题 或 项 目 时 ,经 常 发 现 自己 无 从 下 手 , 很 
难 正 常 地 开展 学 习 和 工作 。 在 这 种 情况 下 ,一 本 深入 浅 出 、 循 序 渐进 又 融合 多 学 科 知 识 的 学 
习 资 料 ,无 疑 可 以 更 快 地 提升 自己 的 工程 实践 能 力 。 

21 世纪 伊始 ,国家 就 开始 大 力 培养 新 型 的 工程 技术 人 才 ,21 世纪 的 新 型 人 才 到 底 应 该 
“新 "在 哪里 ?我 认为 “新 ”应 该 体现 在 人 才 的 创新 能 力 和 解决 复杂 工程 问题 的 能 力 上 。 能 力 
不 是 天 生 的 。 那 么 ,应 该 怎样 培养 这 些 能 力 呢 ? 想 要 提高 这 些 能 力 ,首先 需要 具备 一 些 基础 
的 专业 知识 ,比如 硬件 设计 、 软 件 开 发 .控制 算法 设计 等 。 我们 有 了 这 些 知识 之 后 ,将 这 些 知 
识 融 会 贯通 ,自然 就 能 解决 一 些 复杂 的 工程 问题 。 

《智能 平衡 移动 机 器 人 (MATLAB/Simulink 版 ， 微 课 视 频 版 )》 这 本 书 涉及 基础 硬件 设 
计 、 软 件 开发 .实时 控制 算法 和 多 个 应 用 开发 项 目 ,结合 MATLAB/Simulink 的 强大 仿真 能 
力 和 代码 生成 功能 , 极 大 地 减少 了 开发 成 本 。 作 者 结合 自己 多 年 的 教学 和 实践 经 验 , 以 及 对 
人 才 培 养 过 程 中 痛 点 的 分 析 , 并 基于 智能 平衡 移动 机 器 人 这 个 实践 对 象 , 写 出 了 这 本 较为 实 
用 的 书籍 。 平 衡 移动 机 器 人 是 自 不 稳定 的 .多 变量 、 高 阶 , 非 线性 的 复杂 的 被 控 对 象 ,转向 
灵活 ,是 学 习 \、 研 究 和 工程 应 用 很 好 的 载体 。 这 本 书 系统 地 介绍 了 智能 平衡 移动 机 器 人 
的 开发 全 流程 ,从 基础 应 用 到 高 级 应 用 ,阐述 了 基于 模型 设计 (MBD) 进 行 平衡 移动 机 器 
人 的 开发 ,融合 了 单片机 、C 语言 编程 .电动 机 技术 传感器 与 检测 技术 、 理 论 力学 . 建 模仿 
E .机 器 视觉 .MATLAB/Simulink 等 一 系列 技术 ,使 读者 能 更 好 地 将 所 学 专业 知识 进行 
综合 应 用 和 融会 贯通 ,提高 电 控 系统 的 设计 能 力 。 读 者 不 需要 高 深 的 理论 功底 ,就 能 快 
速 上 手 解决 实际 问题 ,提升 综合 研发 能 力 。 在 掌握 平衡 移动 机 器 人 的 基础 外 设 和 应 用 的 
同时 ,读者 可 以 发 挥 自 己 的 想象 力 , 在 智能 平衡 移动 机 器 人 上 开发 更 多 有 趣 的 应 用 ,在 这 个 
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过 程 中 逐步 提高 创新 能 力 和 解决 复杂 工程 问题 的 能 力 ,真正 做 到 不 但 授 之 以 鱼 ,更 授 之 
以 渔 。 
相信 本 书 能 够 帮助 广大 的 学 生 和 工程 师 提 高 自己 的 综合 能 力 。 
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移动 机 器 人 是 机 器 人 的 一 个 重要 分 支 。 移 动机 器 人 具备 优良 的 稳定 性 和 快速 移动 能 力 
等 优点 ,适用 于 对 机 动 性 和 负载 能 力 有 一 定 要 求 的 场合 。 轮 式 机 器 人 作为 移动 机 器 人 的 一 
种 ,将 更 广泛 地 应 用 到 工业 制造 及 物流 运输 等 场景 中 ,成 为 节省 人 力 成 本 、 提 高 生产 运输 效 
率 完成 特殊 环境 工作 的 必 不 可 少 的 核心 力量 。 

智能 平衡 移动 机 器 人 ,由 于 结构 轻便 .灵活 、 零 转弯 半径 等 方面 的 特点 ,在 以 上 领域 将 更 
具 优 势 。 以 此 为 基础 的 轮 式 机 器 人 平台 ,将 成 为 未 来 一 段 时 间 的 研究 热点 。 该 平台 的 通用 
性 与 可 拓展 性 可 以 为 智能 平衡 移动 机 器 人 赋予 更 多 的 功能 和 应 用 场合 ,促进 其 进一步 的 研 
究 与 扩展 ,同时 其 控制 理论 与 开发 方法 在 类 似 移动 机 器 人 平台 的 设计 过 程 中 也 具有 拓展 性 
和 参考 价值 。 

智能 平衡 移动 机 器 人 的 研究 与 应 用 是 一 门 实践 性 很 强 的 学 科 , 同 时 也 具有 坚实 的 理论 
基础 。 但 以 往 关于 平衡 移动 机 器 人 的 书籍 往往 存在 两 种 倾向 , 一 种 是 过 于 偏重 理论 推导 和 
分 析 ,与 实际 的 工程 实践 与 应 用 相 脱 节 ,难以 引起 读者 (特别 是 初学 者 ) 的 兴趣 ; 另 一 种 基本 
上 是 用 户 使 用 说 明 书 ,读者 难以 理解 各 种 操作 背后 的 理论 知识 ,从 而 无 法 使 其 对 智能 平衡 移 
动机 器 人 的 控制 进行 深入 学 习 。 

本 书 紧 扣 读者 需求 ,采用 循序 渐进 的 叙述 方式 ,深入浅出 地 论述 了 智能 平衡 移动 机 器 人 
的 热点 问题 ,关键 技术 、 应 用 实例 和 解决 方案 。 此 外 ,本 书 还 分 享 了 大 量 的 程序 源 代码 并 附 
有 详细 的 注解 以 及 仿真 模型 搭建 过 程 ,有 助 于 读者 加 深 对 智能 平衡 移动 机 器 人 控制 相关 原 
理 的 理解 。 


一 、 内 容 特 色 


与 同类 书籍 相 比 ,本 书 有 如 下 特色 。 

1. 例 程 丰富 ,内 容 翔 实 j 

本 书 提供 了 多 个 应 用 案例 ,这 些 应 用 案例 由 浅 入 深 可 分 为 3 RA: 基础 外 设 应 用 、 基 于 
智能 平衡 移动 机 器 人 模块 的 外 设 应 用 、 基 于 智能 平衡 移动 机 器 人 的 综合 应 用 ,这 3 部 分 应 用 
构成 了 由 浅 入 深 的 学 习 阶梯 ,便于 读者 一 步 一 步 达 到 最 终 的 学 习 目 标 。 此 外 ,本 书 还 提供 了 
从 零 基 础 入 门 的 ADC、TIM1~4、UART1~2、IIC、GPIO.、SPI、.SWD、EXTI 的 实验 案例 ,以 
及 平衡 移动 机 器 人 的 控制 案例 ,融合 多 种 传感器 \ 伺 服 电 机 、 显 示 屏 、 电 池 、 计 算 机 软件 监控 、 
PID 控制 算法 ,使 读者 能 更 好 、 更 系统 地 掌握 单片机 技术 的 开发 和 应 用 ,而 不 是 孤立 的 一 个 
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程序 。 本 书 所 提供 的 编程 思想 .经验 技巧 ,也 可 为 读者 采用 其 他 机 器 人 进行 编程 控制 提供 
借鉴 。 

2. 原理 透彻 ,注重 应 用 

将 理论 和 实践 有 机 地 结合 是 进行 智能 平衡 移动 机 器 人 研究 和 应 用 成 功 的 关键 。 本 书 将 
智能 平 衔 移动 机 器 人 控制 的 相关 理论 在 硬件 和 软件 方面 进行 了 详细 的 叙述 和 透彻 的 分 析 ， 
既 体 现 了 各 知识 点 之 间 的 联系 ,又 兼顾 了 其 渐进 性 。 在 本 书 第 5.6.7 章 中 详细 介绍 了 智能 
平衡 移动 机 器 人 的 基础 应 用 、 进 阶 应 用 和 综合 应 用 等 多 个 应 用 实例 ,这 些 实例 不 但 可 以 加 深 
读者 对 所 学 知识 的 理解 ,而 且 也 展现 了 智能 平衡 移动 机 器 人 研究 和 应 用 的 研究 热点 。 本 书 
真正 体现 了 理论 联系 实际 的 理念 ,使 读者 能 够 体会 到 “学 以 致 用 ”的 乐趣 。 

多 样 化 .实用 化 .详细 化 是 本 书 介绍 的 实例 的 特点 。 本 书 讲解 的 实例 涉及 单片机 、C 18 
言 编 程 、 建 模仿 真 、 电 动机 技术 .传感器 与 检测 技术 、 理 论 力学 ,MATLAB., 信 号 与 系统 等 多 
个 方面 , 既 有 经 典 实例 (如 ,利用 GPIO 点 亮 一 个 LED 灯 ), 又 有 拓展 实例 (如 ,利用 eCAP Ë 
块 结合 智能 平衡 移动 机 器 人 的 超声 波 模块 HC-SROA 进行 距离 检测 ), 既 体现 智能 平衡 移动 
机 器 人 的 基础 知识 (如 ,基础 平衡 控制 系统 框架 搭建 ), 又 体现 创新 融合 (如 ,利用 红外 循 迹 模 
块 完 成 移动 机 器 人 循 迹 运动 ) 。 

3. 传承 经 典 ,突出 前 沿 

本 书 提供 了 MBD 工程 开发 方法 : 融合 建 模 、 仿 真 . 实 时 控制 .自动 代码 生成 、 硬 件 在 环 
仿真 ,快速 控制 原型 技术 。MBD 在 降低 产品 成 本 、 提 高 生产 效率 等 多 方面 有 着 巨大 的 优势 。 
此 外 , 书 中 提供 的 众多 实例 都 基于 MBD 进行 开发 ,非常 有 助 于 提升 读者 的 科研 能 力 。 

4. 图 文 并 茂 ,语言 生动 

为 了 更 加 便于 读者 理解 知识 要 点 ,本 书 配 备 了 大 量 模型 搭建 过 程 截图 ,以 便 提升 读者 的 
兴趣 ,加深 对 相关 理论 的 理解 。 在 文字 叙述 上 ,本 书 据 奔 了 枯燥 的 平 铺 直 叙 ,采用 案例 与 问 
题 引导 式 , 有 助 于 读者 对 原理 的 进一步 理解 。 


二 、 结 构 安排 


本 书 主要 介绍 智能 平衡 移动 机 器 人 控制 的 相关 知识 , 共 分 为 7 章 。 全 书 的 体系 框架 由 
甄 圣 超 老师 提出 ,全文 由 甄 圣 超 老 师 修改 审定 。 

。 第 1 章 介绍 了 智能 平衡 移动 机 器 人 的 背景 .优势 以 及 平台 简介 。 

。 第 2 章 介绍 了 智能 平衡 移动 机 器 人 平台 的 搭建 以 及 软件 的 安装 和 应 用 。 

。 第 3 章 介绍 了 智能 平衡 移动 机 器 人 的 硬件 电路 接口 . 主 控制 板 电路 .电源 管理 电路 、 
电动 机 驱动 电路 .直流 电动 机 驱动 H 桥 电路 ,传感器 和 外 设 模块 的 原理 和 设计 。 

。 第 4 章 介 绍 了 智能 平衡 移动 机 器 人 所 用 的 数字 信号 处 理 器 TMS320F28069 的 特点 
和 引 脚 与 功能 的 数字 控制 系统 ,并 对 控制 系统 和 系统 控制 器 进行 理论 分 析 。 

。 第 5 章 介绍 了 智能 平衡 移动 机 器 人 芯片 TMS320F28069 内 外 设 的 使 用 原理 ,并 以 基 
础 应 用 为 例 结合 MATLAB/Simulink 实现 芯片 外 设 的 模型 搭建 及 自动 代码 生成 。 

。 第 6 章 介 绍 了 进 阶 应 用 的 相关 MATLAB/Simulink 模型 搭建 与 仿真 。 
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* 第 7 章 介绍 了 智能 平衡 移动 机 器 人 平衡 控制 和 红外 循 迹 的 基本 原理 ,以 及 相关 的 
MATLAB/Simulink 的 仿真 实验 ,包括 直立 环 和 速度 环 的 直立 控制 .红外 循 迹 应 


用 等 。 


=, 配套 资源 

。 教学 课件 工程 文件 .教学 大 纲 等 资料 ,关注 “人 工 智 能 科学 与 技术 ” 微 信 公众 号 ,在 
“知识 ”一 “资源 下 载 *>>“ 配 书 资源 ”菜单 获取 下 载 链接 (也 可 以 到 清华 大 学 出 版 社 网 
站 本 书页 面 下 载 ) 。 

。 微 课 视 频 (25 集 , 共 220 分 钟 ) ,扫描 书 中 各 章节 对 应 位 置 的 二 维 码 观 看 。 


四 、 读 者 对 象 

， 对 智能 平衡 移动 机 器 人 感 兴趣 的 读者 。 

。 机械 工程 .电气 自动 化 ,电子 信息 计算 机 相关 专业 的 本 科 生 、 研 究 生 。 
。 相 关 工程 技术 人 员 。 
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CHAPTER 1 


1.1 背景 介绍 


1.1.1 智能 平衡 移动 机 器 人 介绍 


智能 平衡 式 轮 式 机 器 人 的 模型 源 自 经 典 的 倒立 摆 模 型 ,其 两 轮 同 轴 , 主 体 有 沿 着 轮轴 旋 
转 的 不 稳定 趋势 ,因而 控制 其 重心 的 位 置 、 保 持 主体 的 平衡 是 其 区 别 于 其 他 轮 式 机 器 人 的 主 
要 控制 难点 ,尤其 是 在 运动 过 程 中 保持 自身 平衡 ,这 需要 智能 平衡 机 器 人 能 够 通过 其 外 部 感 
知 器 件 迅速 地 检测 出 自身 重心 的 偏 移 与 绕 轮 轴 方 向 倾斜 角度 的 变化 ,并 传输 到 主 控制 器 去 
控制 执行 部 件 一 一 电动 机 的 迅速 响应 ,从 而 能 够 及 时 抵消 这 种 倾斜 的 趋势 来 保持 可 接受 范 
围 内 的 平衡 。 


1.1.2 智能 平衡 移动 机 器 人 应 用 


移动 机 器 人 是 机 器 人 的 一 个 重要 分 支 , 移 动机 器 人 具备 优良 的 稳定 性 和 快速 移动 能 力 
等 优点 ,适用 于 对 机 动 性 和 负载 能 力 有 一 定 要 求 的 场合 。 轮 式 机 器 人 作为 移动 机 器 人 的 一 
种 ,将 更 为 广泛 地 应 用 到 工业 制造 及 物流 运输 等 场景 中 ,成 为 节省 人 力 成 本 、 提 高 生产 运输 
效率 ,完成 特殊 环境 工作 的 必 不 可 少 的 核心 力量 。 

智能 平衡 式 的 轮 式 机 器 人 ,由 于 结构 轻便 、 灵 活 , 零 转弯 半径 等 方面 的 特点 ,在 以 上 领域 
将 更 具 优 势 。 而 以 此 为 基础 的 轮 式 机 器 人 平台 ,将 成 为 未 来 一 段 时 间 的 研究 重点 ,通过 平台 
的 通用 性 与 可 拓展 性 可 以 为 智能 平衡 式 机 器 人 赋予 更 多 的 功能 和 应 用 场合 ,促进 其 研究 与 
发 展 。 同 时 电力 驱动 电动 机 的 动力 模式 符合 绿色 化 与 电动 化 的 发 展 趋势 ; 灵活 的 控制 方式 
使 得 其 在 载 人 或 载 物 方面 均 有 发 挥 的 空间 ; 基于 模型 等 新 型 的 软件 开发 手段 能 够 实现 更 快 
的 开发 速度 以 及 更 低 的 维护 成 本 。 


1.1.3 基于 模型 设计 与 自动 代码 生成 技术 简介 


计算 机 软件 设计 在 近代 科学 发 展 与 技术 进步 中 起 到 了 关键 的 作用 ,无 论 是 之 前 的 PC 
技术 发 展 . 桌 面 互 联 还 是 近年 来 蓬勃 发 展 的 移动 互联 ,计算 机 技术 无 不 起 到 至 关 重 要 的 作 
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用 。 计 算 机 软件 设计 方法 也 随 着 相关 技术 的 一 步 步 提高 面临 着 一 次 次 的 挑战 。20 世纪 60 
年 代 , 人 类 面临 第 一 次 软件 危机 ,其 原因 在 于 软件 设计 难度 加 大 ,设计 成 本 提高 ,同时 软件 的 
可 靠 性 也 越 来 越 难以 保证 ,为 解决 这 类 问题 ,人 们 先后 提出 了 面向 对 象 技术 以 及 “结构 化 程 
序 设计 ”。 但 是 近 几 年 微 处 理 器 控制 器 的 应 用 越发 广泛 ,硬件 设备 的 增长 引发 了 软件 代码 的 
指数 级 增长 ,软件 结构 性 变 得 复杂 ,安全 性 .可 靠 性 也 越发 显得 重要 。 高 昂 的 人 力 成 本 ,让 传 
统 的 人 工 编 程 设计 方法 越发 显现 出 其 整 端 。 在 不 和 久 的 未 来 ,自动 驾驶 、 物 联网 .人 工 智 能 
(AD 等 新 兴 技 术 日 趋 成 熟 后 ,我 们 身边 的 许多 硬件 产品 都 会 伴随 着 成 千 上 万 行 的 软件 代 
码 , 自 动 驾 驶 等 其 他 更 加 高 端的 技术 领域 的 代码 数量 更 多 ,而 且 复 杂 程 度 也 有 增 无 减 , 开 发 、 
维护 都 会 伴随 着 大 量 的 工作 ,特别 是 高 集成 度 的 项 目 要 求 团队 开发 的 通用 性 及 效率 更 高 。 
而 基于 模型 的 设计 与 自动 代码 生成 技术 的 快速 高 效 、. 兼 容 性 强 .可 复 用 ,质量 控制 有 保障 等 
特性 ,恰恰 能 够 更 好 地 适应 现代 及 未 来 的 软件 设计 需求 。 

基于 模型 设计 主要 是 指 通过 MATLAB 或 者 SCADE 等 计算 机 软件 工具 对 嵌入 式 的 控 
制 系统 进行 控制 算法 的 建 模 与 仿真 ,方便 复杂 系统 设计 的 开展 ,以 及 应 对 集成 度 更 高 的 设计 
要 求 。 由 此 催生 出 的 自动 代码 生成 技术 则 能 够 直接 由 软件 模型 通过 必要 的 工具 及 配置 生成 
能 够 在 目标 处 理 器 上 运行 的 代码 。 其 优势 可 以 总 结 为 以 下 4 点 。 

(1) 图 形 化 模型 化 的 设计 将 更 加 便于 上 手 , 对 工程 师 而 言 意味 着 学 习 时 间 成 本 更 低 , 交 
流 成 本 更 低 ,维护 起 来 也 更 加 有 效率 ,这 一 点 好 比 流程 图 可 以 帮助 我 们 更 快 地 理解 程序 的 开 
发 框架 一 样 , 当 模 型 能 够 完全 替代 传统 代码 时 ,效率 将 会 有 很 大 的 提升 。 

(2) 软件 开发 中 无 法 避免 的 一 个 问题 便 是 BUG( 软 件 漏洞 与 错误 ) 的 引入 ,而 尽快 地 发 
现 并 改正 BUG 便 显得 尤为 重要 ,早期 的 验证 便 是 很 有 效 的 方法 ,每 个 阶段 都 可 以 通过 模型 
去 做 仿真 ,验证 效果 ,这 样 不 会 因为 前 期 的 错误 而 在 后 期 造成 更 大 的 损失 。 

(3) 自动 代码 生成 技术 能 将 很 多 软件 工程 师 从 烦琐 、 枯 燥 的 编程 工作 中 解放 出 来 ,并 且 
大 幅度 地 提高 工作 效率 ,同时 也 不 用 担心 自动 生成 代码 的 质量 与 兼容 性 等 问题 ,可 以 通过 相 
应 的 工具 进行 完善 ,从 而 能 够 专注 于 更 高 层次 的 软件 技术 及 算法 的 开发 。 

(4) 在 基于 模型 的 设计 中 可 以 实现 相关 技术 文件 的 快速 创建 ,由 模型 等 信息 就 可 以 生 
成 详细 的 代码 报告 ,能够 将 整个 系统 软件 的 细节 详细 记录 下 来 ,也 方便 了 工程 师 做 整理 与 发 
布 ,形成 技术 规范 ,有 助 于 项 目 管理 过 程 。 


1.2 智能 平衡 移动 机 器 人 优势 


(1) 智能 平衡 移动 机 器 人 能 够 载重 自身 10 倍 以 上 的 物体 ,并 且 在 路 面 行驶 摩擦 力 小 ， 
具有 速度 快 , 效 率 高 的 优点 。 . 

(2) 8 fiESE MI LARA 5k 95 R 1 , Bl EF AUE GE 71 30. EIRA Wk DU UU FR 
物流 运输 的 电动 车 辆 ,具有 很 好 的 应 用 前 景 。 

(3) 智能 平衡 移动 机 器 人 软 硬 件 知 识 丰富 ,是 较 好 的 教研 载体 ,如 直流 有 刷 电动 机 、 纺 
Ma H 桥 电 路 电动 机 驱动 动力 电池 、 蓝 牙 通信 液晶 屏 、MPU6050 BE SRL, WiFi 通信 、 手 
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机 APP 控制 .串口 通信 、 计 算 机 软件 监控 等 模块 。 

(4) 智能 平衡 移动 机 器 人 结构 轻便 .灵活 ,能够 实现 零 半径 转弯 。 在 许多 工业 应 用 中 能 
够 产生 很 好 的 效果 。 

(5) 智能 平衡 移动 机 器 人 能 够 以 其 自 平衡 移动 底盘 为 载体 ,可 以 进行 多 种 改造 ,例如 ， 
在 机 器 人 上 添加 机 械 辟 实现 移动 抓 取 或 者 安装 消毒 等 工具 进行 移动 消毒 。 


1.3 本 书 内 容 


1.3.1 应 用 平台 


智能 平衡 移动 机 器 人 应 用 平台 分 为 3 部 分 ,包括 软件 部 分 ,硬件 部 分 和 机 械 部 分 。 

(1) 软件 部 分 : 计算 机 搭载 的 MATLAB/Simulink 仿真 软件 .用 于 TI C2000 系列 DSP 
控制 芯片 代码 生成 的 Hardware Support Packages 硬件 支持 包 、TI 官方 集成 开发 环境 及 编 
译 器 CCS9. 0. 1. 00004,C2000 系列 软件 资源 库 ControlSUITE 等 其 他 必 pirata 5x 
持 文档 。 

(2) 硬件 部 分 : 智能 平衡 式 机 器 人 硬件 板 卡 ,集成 了 仿真 器 的 主 控制 板 、 电 源 板 、 驱 动 
板 、 传 感 器 模块 板 及 使 用 BoosterPack 标准 的 接口 板 。 

(3) 机 械 部 分 : 包括 铝 合金 板 若干 .品牌 充电 宝 一 块 . 电 动机 、 编 码 器 、 轮 胎 、 安 装 支架 、 
若干 紧 固件 、 排 线 .数据 线 等 。 


1.3.2 应 用 内 容 


本 书 提供 多 个 应 用 案例 ,这 些 应 用 由 浅 入 深 可 分 为 3 部 分 : 基础 外 设 应 用 、 基 于 智能 平 
衡 移 动机 器 人 模块 的 外 设 应 用 、 基 于 智能 平衡 移动 机 器 人 的 综合 应 用 ,这 3 部 分 应 用 构成 了 
由 浅 和 人 深 的 学 习 阶梯 ,便于 读者 一 步 一 步 达到 最 终 的 学 习 目 标 。 

(1) 基础 外 设 应 用 提供 的 应 用 如 下 所 述 。 

° 时 钟 控制 。 

* GPIO 输出 一 一 LED 跑马 灯 。 

° 定时 器 中 断 Timer0 Interrupt, 

。 SCI 串口 通信 GPIO 输入 一 一 按键 应 用 。 

* SCI 串口 通信 。 

° ePWM 应 用 。 

* eCAP 应 用 。 

* ADC 电压 采集 应 

(2) nero 和 用 提供 的 应 用 如 下 所 述 。 

* eCAP 应 用 一 一 超声 波 测 距 。 

* ePWM 应 用 一 一 电动 机 调 速 。 
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。 IIC 应 用 一 一 MPU6050 数据 读 取 。 

。 eQEP 应 用 一 一 编码 器 信号 采集 。 

* .ADC 应 用 一 一 线性 CCD 数据 采集 。 

(3) 基于 智能 平衡 移动 机 器 人 的 综合 性 应 用 提供 的 应 用 如 下 所 述 。 
。 智 能 平衡 移动 机 器 人 平衡 控制 应 用 。 

。 平衡 控制 进 阶 应 用 。 

。 智 能 平衡 移动 机 器 人 之 圈 内 避 障 应 用 。 

。 智 能 平衡 移动 机 器 人 之 红外 循 迹 应 用 。 


1.3.3 本 书 特色 


(1) 融合 单片机 、C 语言 编程 、 建 模仿 真 , 电 动机 技术 ,传感器 与 检测 技术 、 理 论 力学 、 
MATLAB \ 信 号 与 系统 等 综合 技术 ,对 学 生 在 本 科 阶 段 学 习 的 知识 是 一 次 综合 和 升华 ,能 更 好 
地 进行 综合 应 用 和 融会 贯通 ,提高 用 以 上 技术 进行 电 控 系统 的 设计 能 力 。 这 是 初级 工程 师 , 研 
究 生 、 本 科 生 进入 项 目 开发 的 一 次 实战 演练 ,经 过 这 样 的 综合 训练 ,有 助 于 提升 综合 研发 能 力 。 

(2) 协助 读者 更 好 地 掌握 TI DSP 技术 : 提供 基础 的 实验 案例 ,包括 ADC,TIMI —4, 
UART1~2、IIC、GPIO、SPI、.SWD、EXTI 等 模块 ; 提供 智能 平衡 移动 机 器 人 系统 级 的 控制 
案例 ,包括 多 种 外 部 传感器 、 伺 服 电 机 、 通 信和 模块 .显示 屏 、 计 算 机 软件 监控 、PID 控制 算法 
等 ,可 以 更 好 、 更 系统 地 使 读者 掌握 单片机 技术 。 

(3) 更 深入 掌握 电子 技术 : 包含 二 极 管 、 三 极 管 .MOSFET .逻辑 门 电 路 MOSFET HK 
动 芯片 .H 桥 电 路 电动 机 驱动 . 稳 压 电源 芯片 .蓝牙 和 串口 通信 、 液 晶 显 示 屏 等 技术 ,对 电子 
技术 的 综合 应 用 能 力 进行 提升 。 

(4) 提升 C 语言 编程 能 力 : 要 实现 陀螺 仪 和 加 速度 计 姿 态 传感器 的 读 取 , 卡 尔 曼 滤波 
信号 处 理 .平衡 控制 .通信 、 控 制 指令 接收 等 功能 ,代码 有 近 3000 行 , 通 过 上 位 机 波形 和 控制 
参数 发 送 软 件 代 码 ,对 C 语言 的 综合 开发 能 力也 有 较 大 提升 。 

(5) 自动 控制 技术 : 通过 智能 平衡 移动 机 器 人 的 建 模 、 仿 真 和 实时 控制 ,能 系统 掌握 自 
动 控制 技术 的 数学 模型 .时 域 . 频 域 分 析 方 法 `.PID 的 原理 和 软 硬 件 实现 。 这 是 初级 嵌 人 式 / 
单片机 工程 师 进 阶 到 中 级 工程 师 的 重要 标志 。 

(6) 提供 MBD 工程 开发 方法 : 融合 建 模 ,仿真 、 实 时 控制 .自动 代码 生成 ,硬件 在 环 仿 
X ,快速 控制 原型 技术 ,非常 有 助 于 提升 科研 能 力 。 


1.4 本 章 小 结 
本 章 首先 对 智能 平衡 移动 机 器 人 进行 背景 介绍 ,提出 基于 模型 设计 与 自动 化 代码 生成 


技术 ,并 且 展 示 出 智能 平衡 移动 机 器 人 较 好 的 稳定 性 和 快速 移动 的 能 力 。 然 后 将 本 书 内 容 
分 为 应 用 平台 、 应 用 内 容 和 本 书 特色 等 方面 进行 介绍 。 — 


应 用 平台 的 搭建 


CHAPTER 2 


2.1 应 用 平台 概述 


2.1.1 硬件 平台 


由 算法 与 模型 的 搭建 而 生成 的 代码 需要 在 搭建 的 实验 平台 进行 实验 ,而 完成 这 套 实验 
的 硬件 平台 是 必 不 可 少 的 。 本 书 的 硬件 平台 由 两 部 分 组 成 。 

1) 电 控 部 分 

智能 平衡 移动 机 器 人 硬件 部 分 包括 : 集成 了 仿真 器 的 主 控制 板 、 电 源 板 、 驱 动 板 、 传 感 
器 模块 板 及 Forest SI 主 控 板 。 其 中 , 主 控制 板 负责 运行 控制 程序 以 及 实现 控制 信号 的 输 
出 与 外 部 电 平 信号 的 采集 ; 电源 板 将 锂电 池 的 电压 转换 到 主 芯片 .驱动 芯片 及 其 他 传感器 
合适 的 工作 电压 ; 驱动 板 驱动 电动 机 运行 ; 传感器 模块 板 主要 包括 陀螺 仪 加 速度 计 传 感 
器 .超声波 传感器 .蓝牙 通信 模块 及 线性 摄像 头 传感器 使 用 Forest S1 主 控 板 的 引 脚 引 出 
各 种 外 设 的 功能 接口 ,集成 度 更 高 ,更 加 便捷 。 本 书 所 述 的 移动 机 器 人 也 可 以 使 用 树 莓 派 作 
为 控制 系统 ,搭载 摄像 头 进行 视觉 操作 ,如 视觉 循 迹 、 视 觉 避 障 ,视觉 跟随 等 。 但 本 书 是 基于 
MATLAB/Simulink 进行 移动 机 器 人 开发 的 ,所 以 对 基于 树 莓 派 和 OpenCV 的 视觉 操作 内 
容 不 再 详 述 。 

2) 机 械 部 分 

包括 铝 合金 板 若干 ,充电 宝 一 块 、 电 动机 编码 器 轮胎、 安装 支架 、 若 干 紧 固件 、 排 线 、 数 
据 线 等 。 用 于 承载 硬件 部 分 的 控制 板 可 保证 实验 的 稳定 性 和 可 靠 性 。 


2.1.2 软件 平台 


(1) MATLAB/Simulink; Simulink 是 美国 MathWorks 公司 推出 的 MATLAB 中 的 一 
种 可 视 化 仿真 工具 。Simulink 是 一 个 模块 图 环境 ,用 于 多 域 仿真 以 及 基于 模型 的 设计 。 它 
支持 系统 设计 仿真 、 自 动 代码 生成 以 及 衬 入 式 系统 的 连续 测试 和 验证 。Simulink 提供 图 
形 编辑 器 、 可 自 定义 的 模块 库 以 及 求解 器 ,能 够 进行 动态 系统 建 模 和 仿真 。 

(2) Code Composer Studio: 其 是 代码 调试 器 ,代码 设计 套件 ,缩写 为 CCS, 可 提供 强 
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健 、 成 熟 的 核心 功能 与 简便 易 用 的 配置 和 图 形 可 视 化 工具 ,使 系统 设计 周期 更 短 。Code 
Composer Studio 包含 一 整套 用 于 开发 和 调试 租 入 式 应 用 的 工具 。 它 包含 适用 于 每 个 TI 
器 件 系列 的 编译 器 、 源 码 编辑 器 、 项 目 构建 环境 、 调 试 器 、 描 述 器 、 仿 真 器 以 及 多 种 其 他 
功能 。 l 

(3) controlSUITE: 其 是 TI Jy C2000 开发 者 提供 的 资料 库 和 参考 工具 包 。 其 中 
C2000 每 个 型 号 都 有 对 应 的 样 例 、 手 册 和 设计 指导 ,还 有 各 种 开发 板 平台 的 原理 图 、PCB 
和 使 用 说 明 。 I 

(4) Embedded Coder Support Packages for Texa Instruments C2000 硬件 支持 包 : 能 
够 生成 一 个 实时 可 执行 文件 ,并 将 其 下 载 到 TI 开发 板 。Embedded Coder 自动 生成 C fX 
码 , 并 在 方 框图 中 插入 T/O 设备 驱动 程序 。 


2.1.3 MBD 开发 流程 


基于 模型 设计 (Model-Based-Design,; MBD) 工 程 方 法 主要 针对 汽车 、 飞 机 、 机 器 人 等 电 
控 系 统 、 雷 达 导 航 等 信号 处 理 系统 、 电 力 系统 、 通 信和 系统 等 较 复杂 的 需要 单片机 或 计算 机 作 
为 主 处 理 器 的 控制 系统 设计 ,是 综合 采用 物理 建 模 、 计 算 机 仿真 、 自 动 代码 生成 .软件 模型 与 
控制 器 交互 测试 验证 的 一 种 先进 的 开发 方法 。 如 图 2.1 所 示 为 MBD 开发 流程 。 


项 目 定义 


时 间 


ure 


图 2.1 MBD 开发 流程 


在 传统 的 产品 开发 过 程 中 ,各 模块 相对 独立 ,首先 是 产品 设计 ,接着 是 工艺 设计 ,然后 是 
工装 设计 ,再 进行 产品 制造 ,最 后 对 产品 进行 检验 和 检测 ,各 模块 之 间 几 乎 互 不 干扰 ,很 少 有 
协同 工作 。 这 样 的 产品 开发 过 程 很 大 的 一 个 弊端 就 是 开发 周期 长 , 且 质 量 没有 保障 。 

随 着 数字 化 设计 制造 技术 的 广泛 应 用 ,尤其 计算 机 技术 的 日 益 普及 ,基于 模型 设计 
(MBD) 的 数字 化 设计 与 制造 技术 已 成 为 制造 业 信息 化 的 发 展 趋 势 。 作 为 全 新 的 产品 定义 
方法 ,MBD 在 降低 产品 成 本 .提高 生产 效率 等 多 方面 有 着 巨大 的 优势 ,是 未 来 设计 技术 的 发 
展 方向 。 
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基于 MBD 开发 的 智能 平衡 移动 机 器 人 作为 新 工科 教学 研究 的 载体 ,不 仅 是 一 款 用 于 

学 习 平 衡 移动 机 器 人 原理 及 基本 应 用 的 实验 室 产品 ,也 能 够 作为 智能 车 竞赛 的 载体 ,在 更 高 

的 规则 标准 下 ,进行 更 复杂 的 智能 功能 拓展 和 理论 研究 ,实现 更 高 的 性 能 。MBD 融合 了 建 

模 、 仿 真 . 实 时 控制 .自动 代码 生成 ,硬件 在 环 仿真 ,快速 控制 原型 技术 ,非常 有 助 于 提升 科研 
-能 力 。 如 图 2.2 所 示 为 智能 平衡 移动 机 器 人 的 开发 流程 。 

MBD 开 发 流程 

被 控 对 象 : 智能 平衡 车 | 


Cart 


U 
Pendulum 


Pendulum 


Animation 


控制 模型 设计 


Simulink F 
i Lem. 硬件 在 环 仿真 
$ g+ Š m 
| Ë C 代 码 生成 和 调试 
> — 
BEL 


图 2.2 智能 平衡 移动 机 器 人 开发 流程 


PIL 


2.2 集成 开发 环境 


2.2.1 开发 环境 介绍 


基于 模型 的 设计 到 代码 生成 的 过 程 不 同 于 普通 的 Simulink # 8 fJ 3C. JC UP Xt £ 4 k 
件 , 均 需要 根据 具体 要 求 进行 配置 后 使 用 ,具体 涉及 的 软件 有 下 列 几 种 。 

(1) MATLAB R2020a, Simulink 工具 箱 及 对 应 芯片 的 硬件 支持 包 : 选用 该 版 本 相对 
新 的 MATLAB 软件 在 对 相关 功能 的 支持 方面 有 更 好 的 表现 ,同时 操作 起 来 也 更 加 便捷 ， 
R2020a 仅 支 持 64 位 操作 系统 ,同时 由 于 其 运算 能 力 的 提升 ,要 求 系统 至 少 有 AGB 运行 内 
f£; Simulink 是 依附 于 MATLAB 的 一 个 仿真 工具 箱 , 其 具有 模块 精简 、 参 数 配 置 灵活 、 模 
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型 符合 实际 等 优点 ,广泛 应 用 于 航空 航天 、 信 号 处 理 ,汽车 .电动 机 控制 .通信 行业 等 ,其 有 针 
对 性 的 模块 以 及 易 上 手 的 开发 环境 能 够 帮助 行业 技术 人 员 快 速 完 成 设计 及 仿真 等 功能 。 

(2) Embedded Coder 支持 包 ,该 支持 包 由 MathWorks 公司 与 德州 仪器 公司 (TI) 共 同 
开发 提供 , 相 比 于 传统 用 于 生成 代码 的 RTW-Real Time Workshop 工具 箱 , 其 集成 了 TI 的 
Code Composer Studio, Analog Devices, Visual DSP 十 十 和 其 他 第 三 方 嵌入 式 开发 环境 , 提 
供 了 配置 选项 和 可 以 更 好 地 控制 生成 代码 的 函数 ,文件 和 数据 的 高 级 优化 选项 ,因此 可 以 说 
它 扩 展 了 MATLAB Coder 和 Simulink Coder(RTW)。Embedded Coder 提高 了 代码 效率 ， 
并 且 能 很 方便 地 集成 已 有 代码 ,数据 类 型 和 产品 中 的 标定 参数 。 使 用 Embedded Coder Æ 
成 的 代码 ,可 以 导出 到 第 三 方 的 开发 环境 中 ,可 以 在 嵌入 式 系统 中 自动 创建 可 执行 文件 。 生 
成 的 代码 可 以 在 处 理 器 上 执行 以 验证 性 能 ,可 以 通过 PIL (Processor In Loop) 仿 真 和 代码 
剖析 的 方法 来 查看 代码 在 硬件 上 的 运行 情况 ，。 

(3) Code Composer Studio 9. 0. 1.00004( 以 下 简称 CCS 9. 0. D ,该 软件 为 TI 官方 开 
发 的 适用 于 其 各 系列 DSP 控制 器 的 IDE( 集 成 开发 环境 ) 及 编译 器 软件 ,其 内 部 集成 了 DSP 
代码 生成 工具 .数据 传输 工具 .软件 项 目 开 发 工具 等 ,这 里 主要 用 于 生成 可 以 烧 写 进 芯 片 的 
执行 文件 ,这 一 功能 是 MATLAB 本 身 所 不 具备 的 。 

(4) ControlSUITE 3. 4.5, 这 个 软件 相当 于 为 了 方便 开发 TI 各 系列 芯片 所 提供 的 一 个 
工具 箱 资 料 集 , 它 包含 了 C2000 系列 及 其 他 各 系列 芯片 所 需要 的 所 有 头 文件 与 库 文件 。 在 
实验 中 安装 该 软件 的 目的 是 在 生成 代码 的 过 程 中 ,MATLAB 能 够 从 中 直接 找到 编译 时 所 
需 的 头 文件 、 库 文件 和 支持 代码 。 


2.2.2 软件 安装 及 配置 


d 1) MATLAB R2020a 安装 过 程 
请 先 在 MathWorks 官网 上 购买 正版 MATLAB R2020a 安装 包 以 及 获取 MathWorks 
账号 。 安 装 过 程 如 下 所 述 。 
(1) 双击 打开 MATLAB R2020a win64 安装 包 , 如 图 2. 3 所 示 。 


B8IBA«I Mm EMMATLAB 20202 
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+ MathWorks 


Ren 


图 2.4 电子 邮件 输入 
(3) 输入 账号 电子 邮件 的 密码 ,如 图 2. 5 所 示 , 单 击 “ 登 录 ” 按 钮 。 


< MathWorks Product installer - x | 


+ MathWorks* 
密码 


图 2.5 密码 输入 
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(4) 进入 MathWorks 许可 协议 界面 ,如 图 2.6 所 示 , 先 选中 “是 ” 单 选 按钮 ,然后 单 击 
“下 一 步 ” 按 钮 。 


The MafhiWorks. Inc Software License Agreement 


IMPORTANT NOTICE 


THIS tS THÉ SOFTWARE LICENSE AGREEMENT (THE "AGREEMENT") OF THE MATHWORKS, INC MATHWORKS" 
FOR THE PROGRAMS THÉ PROGRAMS ARE LICENSED, NOT SOLD. READ THE TERMS ANO CONDITIONS OF THIS 
AGREEMENT CAREFULLY BEFORE COPYING, INSTALLING. OR USING THE PROGRAMS. FOR INFORMATION ABOUT 
YOUR LICENSE OFFERING, CONSULT THE PROGRAM OFFERING GUIDE PRESENTED AFTER THE AGREEMENT 


THE AGREEMENT REPRESENTS THE ENTIRE AGREEMENT BETWEEN YOU (THE "LICENSEE") AND MATHWORKS 
CONCERNING YOUR RIGHTS TO INSTALL AND USE THE PROGRAMS UNDER THE LICENSE OFFERING YOU 
ACQUIRE 


wawsnavsmta | sj s “=. SUA 


"vH. ms 

Mathis products are protected Dy patents (ee MACS conpatents ) and copyngt ues Any EA re vie "epeoducon or aintunon mar, 
"esa m OVE and Crmminat penates 

MATLAB and SEUA are regaterec Y poerra/wy of Tit MAAORI ic Please ee matos com rage Nor a vy: of IENE acea Cer 
OO of brand names, riy be Voom or regatened yaoer er of wes sespecbve Noe 


图 2.6 MathWorks 许可 协议 


C5) 进入 确认 用 户 界 面 , 如 图 2.7 所 示 , 输 入 名 字 、 姓 氏 .电子 邮件 和 Windows HP 4 
信息 ,注意 不 要 出 现 汉 字 , 然 后 单 击 “下 一 步 ” 按 钮 ， 


A MathWorks Product Installer 


RWN—TtANLUPRIEFUS, MENHIRS 
GIRDER. URP MathWorkxs WP, ) 
na 


图 2.7 确认 用 户 界 面 
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(6) 选择 安装 目标 文件 夹 , 如 图 2. 8 所 示 , 然 后 单 击 * 下 一 步 ? 按 钮 。 本 次 安装 选择 D 
盘 ,建议 选择 较 大 内 存 空间 的 磁盘 ,因为 MATLAB R2020a 占用 空间 较 大 。 


D^matiab 20202 


VERIBEU I 


图 2.8 选择 目标 文件 来 


(7) 进入 产品 选择 界面 ,如 图 2. 9 所 示 ,根据 工 具 箱 中 的 产品 进行 选择 ,然后 单 击 “ 下 一 
步 ” 按 钮 
< MathWorks Product Installer - x 


2020 


z 
7 
7 
* 
7 
7 
Ed 
7 
z 
* 


图 2.9 产品 选择 界面 
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(8) 进入 “选择 选项 ?界面 ,如 图 2. 10 所 示 , 先 选中 “将 快捷 方式 添加 到 桌面 "和 “通过 癌 
MathWorks 公司 发 送 用 户 体 验 信 息 来 帮助 改进 MATLAB” 复 选 框 ,然后 单 击 “ 下 一 步 ” 
Tc. 


7 AEBSYUDIOMEE 


了 通辽 向 MathiWorks 42 BUR Sas am  (E8S02 8 MATLAB 
rE £ 


图 2.10 “选择 选项 "界面 
(9) 进入 “确认 选择 ”界面 ,如 图 2.11 所 示 , 单 击 “ 开 始 安 装 ” 按 钮 


< MathiWorks Product installer 


40933105 Sponsored . indenidus! 

AcWumm Omanu 

Windows 周 户 各 nedongztineng 
" 


D 'matiab 20208 


9480191) 
me :52308 


图 2.11 “确认 选择 ”界面 
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€ 


(100 等 待 安装 完成 ,如 图 2. 12 Brzn ,然后 单 击 “关闭 ”按钮 。 
| 4 athionks Product installer — = "uw 


SI STO WG URL AR. 


1 OUFPABEESSS Ioas 


Simulink Codor 
MATLAB Coder 


图 2.12 


如 果 安 


安装 完成 界面 


装 完 成 后 ,在 打开 MATLAB R2020a 时 出 现 License Manager Error-9 界面 , 单 


击 图 2.13 中 的 Troubleshoot 按钮 ,会 进入 MATLAB Answers 界面 ,按照 给 出 的 方法 进行 


激活 。 具 体操 

2) Code Composer Studio 软件 安装 

Code Composer Studio 安装 过 程 如 
所 述 。 

(1) 在 安装 之 前 , 先 打开 网 页 下 载 Code 
Composer Studio 软件 ,下 载 此 软件 的 网 址 是 
http://processors. wiki. ti. com/index. php/ 
CCS # Code. Composer . 
Version 6 Downloads. £A JA FR #IJ“ Code Composer 
Studio 9. 0. 1. 00004, Donload Windows" 3f F 
T sa, oa 2.14 所 示 。 

2) 下 载 完 后 ,解压 , 单 击 打开 安装 文件 
RAN .15, 所 示 的 应 用 程序 文件 。 请 注 
意 安装 包 文件 的 目录 不 能 包含 中 文 。 


所 示 , 先 选中 


Download _ ,Studio _ 


(3) 如 图 2 
单 击 Next ni à 


accept the terms of the license agreement 单 选 


作 可 参考 网 页 Why do I receive License Manager Error-9?, 


License Manager Error -9 x 


License checkout failed. 

License Manager Error -9 

Your username does not match the username in the license file. 
To run on this computer, you must run the Activation client to 
reactivate your license. 


Troubleshoot this issue by selecting the button below or visiting: 
https //www.mathworks. com/support/Ime/R2020a/9 


图 2.13 错误 提示 


按钮 ,然后 
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vo RETE 


£m 
2019/11⁄41123 文件 实 

2019/1]/41045 AREF 
2019/11/4 1040 RBK 
2019/11/4 1109. EB 
2019014162 GREF 


图 2.14 安装 包 下 载 


E di B README, FIRST wint 2019251622 — XXE 16 


By 
using the Licensed Materials you agree to abide by the terms of this Agreement. If you choose not t accept or agree 
these terms, do not download or install the Licensed Materials. 


hereby grants you a world-wide, royalty-free, non-exclusive license under copyrights and patents it now or hereafter owns or 


EK a pof porke to a comhblacices ih Inchudo tha cenar Btedale Cf nih dades. M 


图 2.16 安装 许可 协议 
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(4) 选择 安装 路 径 , 如 图 2. 17 所 示 ,为 方便 后 续 MATLAB 与 CCS 关联 ,最 好 保持 默认 
设置 (也 可 以 安装 在 DD 盘 ) ,名 称 就 不 要 改动 了 ,然后 单 击 Next 按钮 。 
Q9 Code Composer Studio v9 Setup 


Choose Installation Location 
Where should Code Composer Studio v9 be installed? 


To change the main installation folder click the Browse button. 


Install 
Texas Instruments. 


EE NNNM NN 
图 2.17 选择 安装 路 径 


(5) 目前 开发 C2000 系列 的 芯片 仅 选择 C2000 real-time MCUs 即 可 ,如 果 有 其 他 需求 
可 多 选 ,然后 单 击 Next 按钮 ,如 图 2. 18 Bron 


图 2.18 芯片 选择 
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(6) 仿真 器 驱动 选择 默认 提供 的 ,本 书 配备 的 智能 平衡 移动 机 器 人 常用 的 是 XDS100v2 
的 仿真 器 。 其 他 功能 在 安装 后 期 可 在 CCS 内 选择 ,并 非 必 需 选 项 ,这 里 暂 不 安装 。 单 击 
Finish 按钮 ,如 图 2. 19 所 示 。 


Q9 Code Composer Studio v9 Setup ” X 
Select Debug Probes 
Select the debug probes you want installed and deselect the debug probes you want to leave out. 


(7) 等 待 安 装 结束 。 如 图 2.20 所 示 , 先 选中 Launch Code Composer Studio 和 Create 
Desktop Shortuct 复 选 框 , 然 后 单 击 Finish 按钮 。 


图 2.20 安装 完成 
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3) controlSUITE 软件 安装 

controlSUITE 安装 过 程 如 下 所 述 。 

(1) 安装 controlSUITE 是 为 了 后 期 生成 代码 时 ,MATLAB 能 够 从 中 找到 需要 的 库 文 
件 . 头 文件 和 支持 代码 。 首 先进 行 解压 ,如 图 2. 21 所 示 ,打开 controlSUITE3. 4. 5setup, 然 
后 双击 运行 ,选择 和 CCS 同样 的 安装 路 径 。 


1B) controtSUITE3.4 Ssetup 2020/7/23 18:17 应 用 程序 1,974,953... 
图 2.21 打开 安装 包 
(2) 首先 单 击 Next 按钮 进入 安装 许可 界面 ,如 图 2. 22 所 示 , 选 中 I accept the agreement 


单 选 按钮 ,然后 单 击 Next 按钮 。 接 下 来 选择 安装 路 径 , 单 击 Next 按钮 ,最 后 需要 选中 
Launch controlSUITE 复 选 框 , 单 击 Finish 按钮 即 可 完成 安装 。 


lil Setup - conwolsurrE - x | Setup - controlSUITE - x 
| | 
| Wcense Agreement D| 
Welcome to the controlSUITE Please read the folloveng important intarmateon before contrrg B 
Setup Wizard =l 
This will instali çontrotSUIT£ vermon 3.4.5 on your computer. En E TM M IUE RUNI IM Palo uhan 


Jis recommended that you close all other agpácatons. c pn 
Source and Object Code Software License Agreement n 


Chick Next to continue, or Cancel to ext Setup. 


Important - Please carefully reed Ihe following license 


(8) 1 accept the agreemant 


| [s s] RN i 


B setup - controlSUrTE =m 


Select Destination Location 
Where ovid controrSuTTE be stelied? 


Completing the controlSUITE 
Setup Wizard 


Setup has firushed estafing controfSulTE on your coenputer. 


y eti mata controtSUITE mto the foliowang foidec 
p "" 由 


To continue, check hast. f you veochd dka to select a déferent folder, chick Browse. 


wee 


Ok Finish to exit Setup. 


A least 5,683.7 MB of free disk space is required. 


图 2.22 安装 步骤 


4) C2000 Simulink 开发 工具 箱 
1) 打开 MATLAB R2020a, 先 单 击 “附加 功能 ”的 下 三 角 按 钮 ,然后 单 击 “ 获 取 硬 件 支 
"选项 ,如 图 2. 23 所 示 ,会 打开 如 图 2. 24 所 示 的 界面 , 单 击 Embedded Coder Support 
— for Texas Instruments C2000 Processors, | 


) 打开 硬件 支持 包 , 单 击 “ 安 装 ” 按 钮 ,如 图 2. 25 所 示 。 
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图 2.23 获取 硬件 支持 包 


Embedded Coder Support Package for Texas Instruments C2000 Processors rem: MathiWorks Embedded Coder Team BISNIS 

Generate code optimized for C2000 MCU 

| Embedded Coder Support Package for Texas Instrurmenty "^ C2000"* Processors enables you to generate a reai-üme executable and download A to your TI 
development board. Embedded Coder automatically 


O nw 


图 2.24 选择 硬件 支持 包 


LLL |o 个 全 分 


图 2.25 安装 硬件 支持 包 


(3) 首先 自己 必须 注册 一 个 账号 ,等 待 一 会 儿 , 出 现 如 图 2. 26 所 示 的 界面 , 单 击 “ 我 接 
受 ” 按 钮 ,出 现 如 图 2. 27 所 示 的 界面 ,然后 单 击 “ 下 一 步 ” 按 钮 。 


š 第 三 方 软件 

MathWorks BEDE DINS mm E-e ajeno ata ERRUSIRHSUL FRU, RETEA 
s Ra PU. - WE(GPL)MIESRERA, 
| TWPORTANT NOTICE " r: 
| eet | | Embedded Coder Support Package for Texas Instruments C2000 
| | Processors BoE 20.12 

READ THE TERNS AND CONDITIONS OF THIS NATHNORKS MUXILIART SOFTWARE | 

LICENSE AGREENENT (THE "NORÉENENT") CAREFULLY BEFORE CHECKING “I | Shen 

ACEFT OR ACCESSING THESE MATERIALS (AS DEFINED BELOV). | 
| | nemo credar Buffer me | 

THIS ACRASNENT NETTEN YOU (THÉ 
| ^LICENSER") AND THE WATHYORKS, INC. (CNATHNORNS") CONCERNING THE TI C2000 Code Generation Tools 许可 还 | 
| TE RE ee NE PESEE TI Concerto ARM Code Generation Tools 许可 证 | 
| 


BY CHECKOE ^l ACCEPT” OR MOCESSING THESE MATERIALS, YOU ACCEPT THE e x — 
TERES Of THIS AGREENENT, 4 


图 2.26 MathWorks 辅助 软件 许可 议 图 2.27 第 三 方 软件 许可 证 


(4) 如 图 2.28 Bros. 等待 下 载 安装 。 注 意 ,请 以 管理 员 身 份 运 行 MATLAB 再 安装 
C2000 支持 包 。 

(5) 安装 完毕 后 , 单 击 “立即 设置 ”按钮 ,如 图 2. 29 Bro. 

(6) 进入 如 图 2. 30 所 示 的 芯片 配置 界面 后 ,取消 选中 TI F2838x、TI Piccolo F28004x 
和 TI F28044 对 应 的 复 选 框 ,然后 单 击 Next 按钮 。TI F2838x, TI Piccolo F2804x 和 TI 
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F28044 都 是 TI 较 新 的 芯片 ,不 需要 安装 。 


其 
安装 完毕 
需要 对 您 的 硬件 不 持 包 进 行 配 狂 ， 
您 可 以 选择 立即 这 成 配置 步 名， 大 塞 在 以 后 通过 MATLAB 工具 条 中 的 附加 功能 管理 上 赔 来 执行 
gm. 
Ix 

下 载 和 安装 进度 

© 正在 下 载 支 持 包 ..100% 

@ (3 / 3) 正在 下 载 第 三 方 包 ..100% 

O 正在 安装 支持 包 .33% 

o Tiram yt 

q 正在 配置 锭 的 安 丢 = ' | 


图 2.28 下 载 和 安装 进度 图 2 29 安装 完毕 


| Select Processors from the list 
(C) Select an zl 
| | TI F2838x IN 
|E] TI Delfino C2834x 
TI Delfino F2833x 
Ti Delfino F2837xD 
Ti Delfino F2837xS 
TI Piccolo F28004x 
TI Piccolo F2802x 
Ti Piccolo F2803x 
TI Piccolo F2805x 
TI Piccolo F2806x 
TI Piccolo F2807x 
TI F28044 
TI F280x 


P Tsay ayayay 


图 2.30 芯片 配置 


(7) 进入 如 图 2. 31 所 示 的 第 三 方 软件 需求 界面 , 单 击 Next 按钮 。 不 安装 TI 最 新 的 世 
片 , 可 以 不 安装 TI C2000 Ware, 

(8) 进入 如 图 2. 32 所 示 的 选择 安装 路 径 界 面 , 会 自动 绑 定 controlSUITE 的 安装 路 径 ， 
单 击 Next 按钮 。 

(9) 进入 如 图 2. 33 所 示 的 界面 后 ,指定 CCS 的 安装 路 径 , 单 击 Browse 按钮 ,按照 如 
图 2. 34 所 示 的 文件 夹 路 径 , 选 择 安装 路 径 ,最 后 单 击 Validate 按钮 进行 校 验 。 之 后 单 击 
Next 按钮 进入 下 一 界面 。 I 
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E Hardware Setup. - x 


Install Third-Party Softw 


Embedded Coder Support Package for Taxas Instruments (TI) requires. Hyperink tatas you to third-party wk 
| the folowing third-party software. Download and nstatlacon process 


dl Hardware Setup I - x 


Validate Control Suite Installation 


|. Specify the TI Control Sune installation folder Sgacóy iha whd instalation kde 


ChconirolSUITE) . Browse | Advanced Setting 


Select custom Headec/Source paths (Advanced setting) tasted vection bam Go contriSUITE. 


| E Hardware Setup - x 


路 径 校 验 


92x ”应 用 平台 的 搭建 |P 21 


< Tm ax p 
` ~ 

iei : A È e 

À Music ^ aR Liz] La] 

| sneg 3 ccs base 2019/2/23 1854 — xxx 
B videos F dec 2019/11/41022 ü= 
] OneDri _ etlipse 2019/11/4 10:29 文件 交 
| š | install info 2019/11/4 10:22 RR 
& WPS 网 盘 E install logs 2019/11/4 1021. — Stm 
z FT um Qs [3 tirex 2019/11/4 10:20 Z 
s -5 tools 2019/11/4 1019 XR 


图 2.34 选择 文件 夹 


(10) 在 如 图 2. 35 所 示 的 界面 中 需要 注意 的 是 CGT 工具 的 选择 , 单 击 Browse 按钮 。 
如 图 2. 36 所 示 , 可 以 在 C:\ti\ccs901\ccs\tools\compiler 目录 下 寻找 安装 的 CGT 工具 ,本 
置 完 成 之 后 , 单 击 Validate 按钮 进行 工具 链 的 验证 。 若 出 现 未 检测 版 本 的 提示 也 没关系 ， 
单 击 “ 确 定 ” 按 钮 , 即 可 进入 到 如 图 2. 37 所 示 界 面 , 再 单 击 Finish 按钮 会 自动 跳 转 到 如 
图 2. 38 所 示 的 界面 ,最 后 单 击 Next 按钮 安装 成 功 。 


D Hardware Setup 


The lider, C thccs901:ccsiooisicomplerfi-cgi-c2000. 18.12 1.LTS, is 
nol a tested compiler version (18.12 2) 
Compie me issues can occur wiih is verson 


[Rm] 


T Select TI C2000 Compiler install location. x 
< = - NE | ve 2E compiler P 
tg > a E> 9 
| | SnagitV1 ^ s L zi] em 
H Videos | dmed 20:9/1/41021 HiS 
* ['] OneDrive L1 i-cgt-arm 18.12.1.LTS 2019/11/4 10:19 SPPA 
J $i-cgt-c2000 18.12-1.LTS 2019/11/4 10:19 — Xt 


图 2.36 CGT 工具 文件 目录 
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Hardware Setup Complete 


The hardware setup process for Texas Instruments C2000 is complete 


EZ] Show examples for support package 


图 2.37 第 三 方 软件 版 本 信息 


| E] Hardware Setup 
Summary of third-party installation 
What to Consider. 
Following is a summary of the third-party software information Ethe version numbers of the 
| third-party soitware listed are corect, 
click Next. Otherwise, chick Back to 
repeat the validation process 


5) 安装 MinGW-w64 C/C++ 

(1) 单 击 工 具 栏 上 的 “附加 功能 ”的 下 三 角 按 钮 ,在 弹出 的 下 拉 菜 单 中 选择 "获取 附加 功 
能 ”选项 ,如 图 2.39 所 示 。 

(2) 在 如 图 2. 40 所 示 的 界面 中 单 击 “安装 ?按钮 。 如 图 2.41 所 示 ,安装 完毕 , 接 下 来 单 
击 “ 关 闭 ” 按 钮 。 
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| 图 17 
| Bii | 


e App 打包 


图 2.39 获取 附加 功能 


下 载 和 安装 进 利 


O termena 100€ 
U0/1) IEEFRMZ S. 159 


sym 


图 2.41 安装 完成 


2.2.3 软件 应 用 基础 


1) MATLAB 应 用 基础 
双击 MATLAB 图 标 , 得 到 如 图 2. 42 所 示 的 软件 界面 图 ,确认 软件 可 以 正常 运行 。 
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图 2.42 MATLAB 软件 界面 


MATLAB 操作 界面 主要 由 MATLAB F H .命令 行 窗口 、 当 前 文件 夹 窗口 以 及 工作 
区 窗口 组 成 。 主 窗口 包括 功能 区 ,快速 访问 工具 栏 以 及 当前 文件 夹 栏 。 命 令 行 窗口 用 于 输 
入 命令 并 显示 命令 的 执行 结果 。 

MATLAB 提供 了 强大 的 帮助 系统 。 例 如 , 单 击 工具 栏 节 按钮 ,出 现 帮助 界面 ,如 图 2. 43 
所 示 ,在 搜索 框 中 输入 所 要 查询 的 关键 字 后 按 Enter 键 , 就 能 得 到 详细 的 帮助 信息 。 


LI 


^o dy dr QU MATLAB Documentation - MatiWorks ll x TE 


zw xm *» res A Xie 
Em 。 TRORBIENRCUERES, LURERE RURTSDUTH. 

mem "UA IL OI 
nn BETA 


MATLAB 


图 2.43 帮助 界面 


单 击 帮助 中 的 “示例 ”按钮 ,可 以 进入 MATLAB 自 带 的 各 种 演示 程序 ,如 图 2. 44 所 示 。 
这 些 演示 程序 对 初学 者 是 很 好 的 学 习 工 具 , 便 于 在 不 同 的 条 件 下 完成 算法 的 仿真 ,并 显示 形 
象 的 可 视 化 结果 。 
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图 2.44 示例 界面 


2) Code Composer Studio 应 用 基础 


双击 Code Composer Studio 9. 0. 1 图 标 ,进入 如 图 2. 45 所 示 界 面 ,选择 工作 空间 , 单 击 
Launch 按钮 。 


© Eclipse Launcher x 


Select a directory as workspace 
Code Composer Studio uses the workspace directory to store its preferences and development artifacts. 


[Use this as the default and do not ask again 
+> Recent Workspaces 


图 2.45 选择 工作 空间 


得 到 如 图 2. 46 所 示 的 软件 界面 ,确认 软件 可 以 正常 运行 。 

进入 软件 界面 后 ,可 以 选中 New Project 和 Import Project。 在 如 图 2. 47 所 示 的 新 建 
项 目 界面 建立 空 项 目 。 设 置 完成 后 , 单 击 Finish 按钮 。 

接 下 来 ,增加 外 设 与 初始 化 头 文件 与 源 文件 ,主要 过 程 为 增加 头 文件 ,增加 源 文件 ,增加 
位 域 结构 体 支 持 源 文件 ,设置 包含 选项 ,最 后 单 击 build 按钮 ,该 项 目 可 以 编译 通过 。 


2.2.4 软件 高 级 应 用 


1) Simulink 高 级 应 用 
-个 典型 的 Simulink 模型 包括 以 下 3 种 类 型 的 模块 : 信号 源 模 块 .被 模拟 的 系统 模块 
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ieee Ves Mages Don Men Seip Vendo Hp 


图 2.46 软件 界面 


Open Resource Explorer to browse a wide selection of example projects... 


o amm] 


图 2.47 建立 空 项 目 


和 输出 显示 模块 。 | 

信和 号 源 为 系统 的 输入 , 它 包 括 常数 信和 号 源 .函数 信号 发 生 器 和 用 户 自 己 在 MATLAB 中 
创建 的 自 定义 信和 号。 

系统 模块 作为 中 心 模块 是 Simulink 仿真 建 模 所 要 处 理 的 主要 部 分 。 

系统 的 输出 由 显示 模块 接收 。 输 出 显示 的 形式 包括 图 形 显示 .示波器 显示 和 输出 到 文 
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件 或 MATLAB 工作 空间 中 3 种 。 输 出 模块 主要 在 Sinks 库 中 。 
首先 ,双击 MATLAB 图 标 打 开 软 件 , 然 后 在 软件 界面 单 击 Simulink K bs Pal , Hd 
Create Model 创建 新 的 仿真 工程 ,如 图 2. 48 所 示 。 


图 2.48 Simulink 界面 


单 击 Blank Library Él f 88 ,出 现 如 图 2.49 所 示 界 面 ,其 中 有 各 种 模块 ,选择 所 需要 的 
模块 拖 忠 ,然后 对 其 进行 连 线 。 


| 中 Simulink Library Browser - 口 x 


ES O C 


Simulink 


Commonly Used Blocks | Jl 
Dashboard I | li j 


Discontinuities Coamonl y Continuous Dashboard 
Discrete Used Blocks 
Logic and Bft Operations 


Lookup Tables i 
Math Operations lu 
Messages & Events D 


Model Verification 
Model-Wide Utilities 


Discontinuities ^ Discrete — Logic and Bit 
Operations 


Ports & Subsystoms 


Signal Attributes ! h 
Signal Routing i 
Sinks Ë li 


Sources 
String Lookup Math Messages 
User-Defined Functions Tables Operations & Events 


| > Additional Math & Discrete n 
|| > Aerospace Blockset fi 
|| > Audio Toolbox ç 1 
> Automated Driving Toolbox Model-Wide Mode. 

> AUTOSAR Blockset Utilities Verification Subsystems 
> Communications Toolbox E 
> Communications Toolbox HDL Support I] 
> Computer Vision Toolbox 
? Control System Toolbox jj 

Data Acquisition Toolbox Signal Signal 
< Attributes Routing 


图 2.49 模块 库 
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在 选择 所 需要 的 模块 并 拖 忠 到 界面 之 后 ,可 以 对 其 进行 操作 。 例 如 ,对 于 选中 的 模块 如 
果 需 要 旋转 ,可 单 击 模块 然后 按 Ctrl 十 R 键 ,模块 将 顺 时 针 方 向 旋转 90"。 如 需要 改变 模块 
的 标签 ,可 在 标签 的 位 置 上 双击 , 则 模块 标签 进入 编辑 状态 。 编 辑 完 标签 后 ,在 标签 外 的 任 
意 位 置 单 击 , 则 新 的 合法 标签 将 被 确认 。 | 

在 使 用 模型 时 ,加 入 模型 注释 可 以 使 模型 更 容易 读 懂 。 在 模型 窗口 中 任何 想 要 注释 的 
位 置 双击 ,将 会 出 现 一 个 编辑 框 ,在 该 框 内 输入 想 要 注释 的 内 容 即 可 。 

在 完成 模型 的 建立 后 ; 单 击 Run 图 标 辐 运行 模型 。 

例如 ,智能 平衡 移动 机 器 人 的 角度 平衡 控制 算法 、 速 度 控制 算法 、 转 向 控制 算法 等 都 是 
基于 Simulink 进行 搭建 的 。 

2) Code Composer Studio 高 级 应 用 

以 两 轮 平衡 移动 机 器 人 为 例 , 讲 解 如 何 将 已 有 的 工程 导入 并 运行 。 

在 菜单 栏 Project 选项 卡 中 选择 Import CCS Projects, 找 到 工程 文件 的 目录 , 即 可 导入 


到 左 侧 的 Project Explorer, 如 图 2. 50 所 示 。 


iM aie e ro 


1//! 
| 2//V$888: 本 实验 利用 GPIO25 和 GPIO31 作 为 普通 IO 控制 LED 灯 的 亮 灭 $ 


4//$ file main.c $ 
5//$ author HeDong $ 
6//$ version v1.8 $ 
7//$ project F28069GPIO LED $ 


M3 
| 10#include "DSP28x Project.h" // 头 文件 
11 
| 12void InitLEDGPIO(void);  //InitLEDGPIO()üBB SB 
| 13void LEDOverTurn(void); ^ //LEDOverTurn() ittis 


| 14 
| 15 //Flashi$si8 TE 
| 16extern Uint16 RamfuncsLoadStart; 
17extern Uint16 RamfuncsLoadEnd; 
| 18extern Uint16 RamfuncsRunStart; 
| 19extern Uint16 RamfuncsLoadSize; 
| 20 


int main(void) $ 


| 21 / /tititititt FF 
| 22// $ 函数 名 称 : 
23 / ttt 
4int main(void) 
25{ 
6  InitSysctrl();  // máta, 90MHz 
7 


os DINT;  // 清除 所 有 中 断 


图 2.50 程序 界面 


CCS 的 仿真 调试 功能 十 分 好 用 ,可 以 帮助 用 户 发 现 程序 中 的 问题 ,也 可 以 帮助 熟悉 底 
层 硬 件 的 实际 操作 流程 及 现象 ,更 好 地 学 习 DSP 的 开发 与 调试 。 

单 击 CCS 工具 栏 上 绿色 的 Debug 按钮 ,就 可 以 对 工程 文件 进行 编译 ,链接 ,生成 可 执行 
文件 ,然后 下 载 到 TMS320F28069 控制 芯片 上 。 

注意 ,在 单 击 Debug 按钮 与 芯片 进行 连接 前 , 先 要 确认 仿真 器 已 经 连接 ,芯片 已 经 上 
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电 ,接着 进入 仿真 界面 ,如 图 2.51 所 示 。 


File Edit View Project Tools [Run Scripts | [Fun Scripts | findow Help 
Ir > E H vic TE arope- s e cie einoio + 


E 2.51 区 域 划分 


1 号 区 域 代表 程序 的 运行 开始 .暂停 和 中 止 , 以 及 单 步 运行 .运行 人 函数 .运行 出 函数 。 

2 号 区 域 可 以 进行 芯片 的 断 开 与 连接 操作 ,以 及 1 号 区 域 可 以 完成 的 功能 。 

3 号 区 域 是 仿真 状态 栏 ,观察 仿真 的 状态 。 

4 号 区 域 是 程序 界面 ,可 以 在 其 中 设置 断 点 ,观察 程序 是 否 能 顺利 运行 到 断 电 ,方便 

5 号 区 域 有 3 个 选项 卡 : Expressions 是 用 户 可 以 在 程序 界面 中 添加 全 局 变量 到 此 处 进 
行 观测 ; Register 顾名思义 是 能 够 观测 所 有 的 芯片 内 部 寄存 器 ,这 个 区 域 右上 角 有 个 实时 
刷新 的 功能 按钮 ,点 开 后 就 可 以 以 一 个 较 高 的 速度 实时 刷新 来 观测 寄存 器 以 及 变量 的 值 ; 
Variables 用 来 观察 局 部 变量 。 

6 号 区 域 是 内 存 观测 区 ,输入 变量 内 存 地 址 就 可 以 查 到 对 应 内 存 地 址 中 的 值 。 


2.3 本 章 小 结 


本 章 针对 智能 平衡 移动 机 器 人 的 应 用 平台 搭建 ,首先 对 智能 平衡 机 器 人 的 应 用 平台 从 
硬件 .软件 以 及 MBD 开发 流程 3 个 方面 进行 概述 ,描述 智能 平衡 机 器 人 的 搭建 过 程 。 其 次 
通过 对 开发 环境 的 介绍 和 所 用 软件 的 安装 以 及 基本 应 用 方法 的 介绍 ,方便 在 后 续 的 实验 中 
进行 研究 。 
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CHAPTER 3 


本 章 的 主要 内 容 包括 智能 平衡 移动 机 器 人 平台 统一 硬件 接口 电路 的 设计 ,关键 的 主 控 
板 . 电 源 板 .驱动 板 及 其 他 传感器 及 拓展 模块 电路 的 设计 。 


3.1 硬件 电路 接口 设计 


为 了 使 智能 平衡 移动 机 器 人 达到 更 好 的 平衡 控制 效果 ,机 器 人 的 本 体 设 计 更 为 轻 
便 、 集 中 。 机 器 人 的 硬件 电路 也 进行 集中 化 设计 ,整个 机 器 人 本 体 使 用 一 块 控制 底板 
Forest S1 ,使 其 功能 外 设 都 能 通过 这 块 控制 底板 引出 ,这样 大 大 提升 了 整 车 的 集成 度 和 控 
制 的 灵活 性 。 移 动机 器 人 控制 底板 Forest S1 的 原理 图 与 安装 示意 图 分 别 如 图 3. 1 和 
图 3. 2 所 示 。 


5V 1 
GND 2]3V 
GND 
PB6 3 
PB7 : 4 | PB6 
PB7 
PB8 5 
GS — —— BS 
PB9 6 
PCI3 7 | B9 
PCI3 
PC14 8 
PC14 
PCIS 9 
PC15 
PAO i0 
PA0 
PAI Ue 
PAZ 12 
PA2 
PA3 13 
PA3 
GND 14 
3V3 15 | GND 
3V3 
Forest S1 
图 3.1 Forest S1 原理 图 图 3.2 Forest S1 安装 示意 图 


硬件 电路 主要 模块 包括 : 主 控制 器 电路 (包含 了 仿真 电路 ) 负 责 运 行 控制 程序 以 及 实现 
控制 信号 的 输出 与 外 部 电 平 信号 的 采集 ,电源 管理 电路 将 锂电 池 的 电压 转换 到 主 芯 片 .驱动 
芯片 及 其 他 传感器 合适 的 工作 电压 ,电动 机 驱动 电路 驱动 电动 机 运行 ,传感器 电路 用 于 自身 
姿态 和 周围 环境 信息 的 采集 以 及 其 他 拓展 接口 电路 。 
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3.2 主 控制 板 电路 


主 控制 顺 主 要 包括 仿真 电路 与 主 控 芯 片 电路 ,使 得 主 控制 板 在 脱离 其 他 模块 的 时 候 也 
能 够 独立 进行 仿真 与 程序 的 运行 ,所 有 需要 的 功能 引 脚 通过 Forest SI. 主 控 板 的 引 脚 引出 ， 
主 控制 板 的 独立 设计 使 得 移动 机 器 人 的 元 器 件 集成 度 更 高 ,便于 机 器 人 移动 时 的 平衡 控制 ， 
其 主 控制 板 电路 结构 如 图 3. 3 所 示 。 


倾角 传感器 
IIC 


SCIB SCIA 


图 3.3 主 控制 板 电路 结构 


通常 在 实时 数字 信和 号 处 理 中 ,高层 处 理 算法 的 特点 是 所 处 理 的 数据 量 与 低层 算法 相 比 
数据 量 少 , 但 算法 结构 复杂 ,可 以 使 用 运算 速度 快 . 寻 址 方式 灵活 .通信 机 制 强大 的 DSP 芯 
片 来 实现 。 由 于 智能 平衡 式 机 器 人 本 身 结构 上 具有 的 不 稳定 性 ,要 求 姿态 检测 与 相关 控制 
量 的 计算 能 够 达到 一 定 的 频率 来 实现 更 稳定 的 控制 ,为 了 实现 更 好 的 控制 效率 ,控制 器 采用 
TI C2000 系列 DSP 控制 芯片 TMS320F28069 数字 信和 号 处 理 器 ,作为 一 种 高 效率 的 32 w PE 
点 CPU ,其 特有 的 eQEP 功能 即 正 交 解码 单元 使 得 读 取 编码 器 信号 变 得 简单 ,使 得 电动 机 
的 速度 与 位 置信 号 能 够 被 准确 采集 ,其 余 外 设 功 能 丰富 ,具体 特性 如 下 所 示 。 

(1) 内 核 。 . 

° 高 效率 32 位 浮 点 CPU(TMS320C28x) 。 

。 主 频 90MHz(11. 11ns 周期 时 间 ) 。 

。 了 哈佛 (Harvard) 总 线 架 构 。 

。 快速 中 断 响 应 及 处 理 。 

。 高 编码 效率 (采用 C/ C++ 语言 和 汇编 语言 ) 。 

(2) 运算 。 

° 浮 点 单元 ,具有 本 地 单 精度 浮 点 运行 功能 。 

° 可 编程 控制 律 加速 器 (CLA)。 


32 || 智能 平衡 移动 机 器 人 (MATLAB/Simulink 版 . 微 课 视频 版 ) 


。 32 位 浮 点 数学 加 速 器 。 
* 对 C28x 指令 集 进行 了 扩展 以 支持 复数 乘法 及 循环 元 余 校 验 (CRC)。 

(3y 存储。 

° 艇 入 式 内 存 。 

。 高 达 256KB 内 存 。 

。 容量 高 达 100KB 的 RAM, 

(4) 低 功 耗 。 

| 仅 需 单 电源 3. 3V 供电 ,无 电源 上 电 顺 序 要 求 。 

* 低 功 耗 操作 模式 。 

(5) 时 钟 。 

。 无 须 外 部 晶振 ,内 部 集成 了 两 个 独立 的 振荡 器 ,每 个 振荡 器 频率 为 10MHz。 

。 单 片 晶 体 振 荡 器 /外 部 时 钟 输入 。 

。 支持 动态 PLL 比率 改变 。 

。 看 门 狗 定 时 器 模块 。 

(6) 增强 的 控制 外 设 。 

。 可 支持 所 有 外 设 中 断 的 外 设 中 断 扩 展 (PIE) 模 块 。 

° 34-32 (ë CPU 定时 器 。 

。 BIK 8 个 增强 型 脉 宽 调制 器 (ePWM) 模 块 。 

* 总 共 16 个 PWM 通道 [其 中 有 8 路 能 够 支持 高 分 辨 率 PWM(HRPWM) 通 道 ]。 

。 每 个 模块 中 独立 的 16 位 定时 器 。 

。 3 个 输入 捕获 (eCAP) 模 块 。 

。2 个 正 交 编码 器 (eQEP) 模 块 。 

° 16 通道 12 位 ADC, 双 通道 采样 以 及 保持 采样 率 高 达 3MSPS。 

° 如 果 选 择 内 部 3. 3V 参考 源 , 输 入 电压 为 0 一 3. 3V。 

C) 串 行 接口 外 设 。 

。 Bik 2 个 串 行 通信 接口 (SCI) 模 块 。 

。 两 个 串 行 外 设 接口 (SPT) 模块 。 

。 一 根 内 置 集成 电路 (IIC) 总 线 。 

主 控制 电路 首先 将 USB 口 的 5V 电压 通过 TLV1117LV33 芯片 转换 到 3. 3V 为 主 控 
TMS320F28069 芯片 以 及 USB 转 串 口 芯 片 FT2232H 供电 ,仿真 电路 与 主 控 电路 通过 多 通 
道 的 数字 隔离 芯片 ISO7240、ISO7231 与 主 控 电路 进行 电磁 隔离 ,保证 主 控 电路 的 稳定 运 
ÍT; 其 中 93LC56BT-IOT 为 2KB 的 Microwire 兼容 串 行 的 EEPROM, 用 于 存储 烧 写 的 仿 
真 器 固件 。 仿 真 电路 如 图 3.4 所 示 。 

仿真 电路 采用 的 是 XDS100V2 仿真 器 ,从 名 称 中 可 以 反映 出 版 本 ,对 TI 全 系列 芯片 兼 
容 。 通 过 14 引 脚 的 接口 进行 仿真 调试 ,支持 TI 公司 的 官方 编译 器 CCS 系列 V6 及 以 上 版 
本 ,兼容 多 种 PC 操作 系统 以 及 MAC 系统 。 其 特性 有 : 支持 USB 2.0 高 速 接口 ,支持 多 种 
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处 理 器 如 TMS320F28x, TMS320C28x, TMS320C54x, ARM9, ARM Cortex-A8、ARM 
Cortex-A9 和 Cortex-M3 等 ,支持 断 电 检测 , 自 适应 时 钟 支持 Code Composer Studio V6 和 
更 高 版 本 , 主 控 电 路 引 出 引 脚 如 图 3.5 所 示 。 


Ul 
eno 37 GPIOUEPWMIA ADCINAD i 
GPIO GPIOI/EPWMIB/COMPIOUT 
PIO GPIO2/EPWM2A 
GPIÓA GPIO3/EPWNOB/SPISOMIA/COMP2OUT 
GPIÓS GPIO4/EPWM3A 
> GPIOS/EPWM3B/SPISIMOA/ECAPI ADCINAS 
GPIOG/EPWMAA/EPWMSYNC/EPWMSYNCO | ADCINAG/COMP3A/AIO6 
GPIO7/EPWM4B/SCIRXDA/ECAP2 
SR GPIOS/EPWMSA/AI A 
a GPIOS/EPWMSB/SCITXDB/ECAP3 
GPIOIQ/EPWM6A/. 
GPIO12 j^] GPIOI L/EPWMÓB/SCIRXDB/ECAPI 
GPIOI2/SCITXDA/SPISIMOB/TZ1 
[E eR 
sg | GPIOI4/TZ3/SCITXDB/SPISIC 
UARIBRX S | GpIOISIECAP2/SCIRXDB/SPISTEB 3V3 
GPIO16/SPISIMOA/TZ2 - 
GRO E GPIOT7/SPISOMIA/TZ3 
24 | GPIOIS/SPICLK. XDB/XCLKOUT c 
OEPIA r: GPIOIS/XCLKINSHETEASCIRXDB/ECAPI OF 
SEPIB GPIO20/EQEPLA/MDXA/COMPIOUT 
| GPIO2I/EQEPIB/MDRA/COMP2OUT == 
GPIO23 5—] GPIO22/EQEPIS/MCLK XA/SCITXDB Cg 
LED2 YI 
GPIO2S/ECAP2/EQEP2B/SPISOMIB [S E xs03230MSB2GI 
; emper re SEA eel ° 
PIO27/HRCAP2/EQEP2S/SPISTEB/USBODM 
miia A/SDAA/TZ2 cu 
GPIO30 2 
LEDI GPIO30/CANRXA/EQEP2UEPWMTA | 3V3 
GPIO31/CANTXA/EQEP2S/EPWM8A Bia 
Q9 | GPIO39 > Hi 
SEIO% 82 | GPIOAU/EPWMTA/SCITXDB Oo 2s 
y GPIO4MEPWM7B/SCIRXDB 
GPIO | EO Lolo 
GPIO43/EPWMSB/TZ2/COMP2OUT pa e $—31 
GPIO44/MFSRA/SCIRXDB/EPWM7B T 
GP1050 E Na sassa, was, EID i 
BIOSTB GPIOSQ/EQEPIA/MDXA/TZI 5 
a; s I GPIOSUEOEPIB/MDRA/TZ3 _ [997 i I 
GPIOS2/EQEPIS/MCLK XA/TZ3 čis [cie |o. cis [eio [coo jon 
OEP2A | GPIOSS/EQEPIIMFSXA — 
OEP2H GPIOSA/SPISIMOA/EQEP2AJHRCAPI 2au prar pour pasear p 
ss | GPIOSS/SPISOMIA/EQEP2B/HRCAP2 
20| GPIOSG/SPICLK A/EQEP2I/HRCAP3 = 
UARTB TX 4 | GPIOS7/SPISTEA/EQEP2S/HRCAP4 
GPIOSS/MCLKRA/CITXDB/EPWMA 
BE i GPIO32/SDAAJEPWMSYNCU/ADCSOCAO. 
sg | GPIO33/SCLA/EPWMSYNCOI/ADCSOCBO 
*—| GPIO34/COMP20U T/COMP3QUT. 
TDI GBIO3S/TDI (23 «24 E25 |C26 27 28 
MS Ps —34 
TDO DT = P auf p 2nFp 2nF2 2pFP 28FP 2uF 
x a 
TRST GPIO3S/XCLKIN/TCK| © [2 — 1] 
< w 
RESET# TEST2 26 — — 1 


XRS 
TMS320F28069MPZT kË 


图 3.5 主 控 心 片 功能 引 脚 原理 图 


JTAG 相关 引 脚 与 FT2232 相连 ,除了 LED 灯 与 KEY 用 到 的 10 口 以 及 CAN 
connector 接口 ,其余 功能 引 脚 引 到 主 控 板 的 P2 和 P3 处 ,具体 引 脚 功能 如 图 3. 6 所 示 ,再 通 
过 与 其 他 接口 相同 模块 的 连接 来 实现 外 部 信号 与 主 控 芯 片 的 相互 传递 。 

其 中 ,3. 3V 用 于 主 控 板 供电 ,使 用 开关 So 来 实现 主 控 板 USB 电源 未 连接 时 通过 外 部 
电源 管理 电路 来 为 主 控 板 供电 。 
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GPIO52 


l l 
2 2 
3 3 
4 d 
5 5 
6 6 
7 7 
8 8 


UARTA RX 
UARTA TX 
UARTB TX 
UARTB RX 


图 3.6 主 控 板 原理 图 


3.3 电源 管理 电路 


由 于 系统 较为 复杂 ,各 模块 的 供电 电压 也 有 区 别 , 需 要 利用 电源 模块 来 实现 各 部 分 硬件 
电路 的 不 同 电 压 供给 ,因此 电源 模块 中 包含 多 个 电压 转化 电路 。 供 电 电 池 采 用 移动 电源 ( 充 
电 宝 ) 的 原理 简单 ,在 外 部 电源 供应 的 场合 预先 为 内 置 的 电池 充电 , 即 输入 电能 ,并 以 化 
学 能 形式 预先 存储 起 来 , 当 需 要 时 即 由 电池 提供 能 量 及 产生 电能 ,通过 电压 转换 器 (直流 - 
直流 转换 器 ,如 图 3.7 所 示 ) 提 供 所 需 电压 ,电量 
约 为 10000mAh , 满 电压 约 为 5. 0V( 输 出 升 压 至 
12.0V) ,使 用 XL2596S 将 12V 转化 为 5V( 如 
图 3. 8 所 示 ) ,使 用 TLV1117LV33 将 -5V 转化 为 
3. 3V, 用 于 主 控 板 供电 及 其 他 电路 的 外 接 设 备 供 
电 ( 如 图 3.9 所 示 )。 


图 3.7 电压 转换 器 


图 3.8 12V 转 5V 原理 图 


通过 以 上 3 部 分 电路 ,得 到 的 5V 与 3. 3V 通过 Forest SI 引 脚 对 外 输出 ,如 图 3. 10a) 
所 示 ,而 12V 则 单独 通过 tbl 向 电动 机 驱动 板 输出 ,如 图 3. 10(b) 所 示 。 
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5V U4 AMSI117 , 
Vin Vout 6 3V3 
C4 GND == C5 
0.1uF 224F| 0.1hF 
GND = 
GND 
LED 
RI 
mp 71 
LSkQ _L 


图 3.9 5V 转 3.3V 原理 图 


Forest S1 
(a) 


Fd 3.10 电源 板 接口 原理 图 


选用 锂电 池 作 为 外 部 电源 ,是 因为 锂电 池 没 有 记忆 效应 , 充 放 电 的 次 数 较 多 ,能 量 密度 
大 ,安全 性 较 高 , 充 放 电 性 能 也 更 好 。 锂 电池 或 锂 离 子 聚 合 物 电 池 不 管 以 重量 计算 或 以 体积 
计算 ,能 量 密度 都 是 最 高 的 。 此 外 ,锂电 池 或 锂 离 子 聚 合 物 电池 在 充电 及 放电 过 程 中 的 效率 
也 较 高 。 但 是 锂电 池 过 充 或 过 放 很 容易 使 电池 永久 损坏 ,所 以 需要 有 较 精 密 的 电子 线路 控 
制 其 充 放电 ; 而 且 锂 电池 在 高 温 下 会 自燃 ,因此 安全 性 及 稳定 性 极为 重要 ,需要 提供 可 靠 的 
安全 保护 电路 防止 任何 导致 超 温 的 情况 出 现 。 

锂电 池 有 硬 的 外 壳 , 锂 离子 聚合 物 电 池 则 没有 ,所 以 锂电 池 理 论 上 会 轻微 略 重 ,而 锂 离 
子 聚 合 物 电 池 由 于 没有 硬 壳 ,便于 制 成 特定 尺寸 以 配合 外 观 ,但 锂 离子 聚合 物 电 池 在 充满 电 
后 体积 会 略为 膨胀 变 大 ,需要 在 设计 时 预 留 空间 ,免得 电池 内 压力 过 大 而 造成 危险 。 

如 图 3. 11 所 示 , 电 池 电 压 由 电阻 分 压 , 在 ADO 处 采集 到 的 电压 为 实际 电池 电压 的 1/11. 
将 采样 值 代入 式 (3. 1) 进 行 计算 (这 里 ADC 采样 精度 为 12 位 ) 。 

Battery Voltage = Get. Battery X 3. 3 X 11/4096 (3. 1) 

再 根据 判断 标准 对 测 得 的 电量 变量 Battery Voltage 进行 判断 , 当 电 量 低 于 阅 值 时 ,设置 拉 
低 GPIO56 来 使 得 蜂 鸣 器 工作 ,从 而 实现 电量 不 足 的 报警 。 
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1002CR 
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LED green 


图 3. 11 电压 采集 及 报警 电路 


3.4 电动 机 驱动 电路 


直流 电动 机 驱动 的 理想 简化 模型 如 图 3. 12 所 示 。 
图 3. 12 中 U 为 输入 到 电动 机 的 电压 源 ,电线 与 绕 
组 中 的 电阻 与 电感 分 别 用 尺 与 L 表示 ,电动 机 转子 旋 
转 时 产生 的 反 电 动 势 用 下 表示 ,电流 i 方向 如 图 3.12 
所 示 ,T 为 带动 负载 旋转 所 需 的 扭矩 。 为 了 达到 轮 式 
机 器 人 的 平衡 ,最 重要 的 是 根据 当时 车 身 的 姿态 及 车 
轮 的 速度 来 实时 地 对 输出 扭矩 做 调整 ,而 电动 机 的 负 
载 扭 矩 由 电流 决定 ,可 概括 为 如 式 (3. 2) 的 线性 关系 式 。 
T = hu Xi (3.2) 
因此 通过 控制 电流 i S n] DASS | B, h BL BJ PER LA El 3. 12 中 可 以 得 到 电压 守恒 方程 

式 , 如 式 (3.3) 所 示 。 


图 3.12 直流 电动 机 驱动 简化 模型 


U=RXi+L EE (3.3) 


转速 越 快 ,切割 磁 感 线 速 度 越 快 , 反 电 动 势 E 越 大 ,也 可 以 用 线性 关系 式 (3. DORR. 


E =k, Xw (3.4) 
对 公式 (3. 3) 做 拉 普 拉 斯 变换 可 以 得 到 式 (3.5)。 
U(s) — bw) 
pe ES ; (3.5) 


由 式 (3.5) 可 以 得 到 ,排除 固定 的 系数 ,电动 机 电流 的 大 小 与 给 定 电压 .实际 转速 线圈 
电感 与 线圈 电阻 由 以 上 关系 共同 决定 ,线圈 的 电感 与 电阻 为 系统 常量 ,所 以 想 要 调节 电动 机 
转 矩 了 ,可 以 通过 调节 给 定 电 压 从 而 改变 电流 来 间接 实现 转 矩 的 调整 ,至 于 转速 w 也 会 随 
其 他 变量 的 变化 而 变化 ,所 以 不 能 作为 调整 的 主体 。 

综 上 所 述 ,电压 控制 是 直流 电动 机 驱动 的 主要 任务 。 直 流 电动 机 的 转速 较 高 ,需要 通过 
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一 级 或 者 多 级 的 减速 器 来 增加 扭矩 以 及 控制 性 能 ,这 里 使 用 的 永 磁 有 刷 直 流 电动 机 额定 功率 
为 4.3W, 额 定 电压 为 12V, 额 定 电流 为 360mA, 堵 转 电流 为 2. 8A BOE TERR 1kg * cm, Jii fi 
最 大 转速 为 10000rpm ,实际 空 载 转速 为 330 士 10rpm ,减速 器 减速 比 为 1 比 30。 

由 图 3. 13 可 以 看 出 ,在 加 速 阶段 ,转速 提升 时 的 加 速度 基本 与 电 枢 电压 呈 线 性 关系 ,加 
速 时 间 由 电动 机 转动 惯量 ,减速 器 传动 比 等 因素 决定 ,一 般 不 超过 一 秒 , 当 加 速 至 恒 速 时 ,最 
大 速度 与 电压 之 间 同 样 显示 出 了 正 相 关 关 系 。 


对 于 电动 机 运动 
模型 进行 了 简化 


E; 
ma mane — “ 
阶段 


图 3.13 直流 电动 机 转速 特性 图 


结合 有 刷 直 流 电动 机 的 原理 ,平衡 移动 机 器 人 采用 的 是 TI 公司 的 TB6612 系列 的 有 刷 
直流 电动 机 驱动 芯片 。TB6612 电动 机 驱动 芯片 有 两 个 全 桥 电路 可 以 同时 驱动 两 个 直流 无 
刷 电动 机 ,其 中 一 个 简单 的 PWM 接口 便 可 以 方便 地 对 控制 器 电路 进行 接 入 ,峰值 输出 电流 
为 2A, 宽 电源 电压 范围 为 2.7 一 10.8V。 其 控制 框图 如 图 3. 14 所 示 。 


图 3.14 电动 机 控制 原理 框图 


AIN1 和 AIN2 引 脚 控制 着 AOUT1 和 AOUT2 的 输出 ,同样 ,BIN1 和 BIN2 控制 着 
BOUT1 和 BOUT2 的 输出 ,其 作为 1/O 口 进行 控制 电动 机 时 ,控制 逻辑 如 表 3. 1 所 示 。 
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3.1 1/0 口 模式 电动 机 控制 逻辑 表 


xINI xIN2 xOUTI xOUT2 功 能 
0 0 Z Z 平稳 滑行 /快速 停止 
0 1 í. H 反 转 
1 0 H Jš 向 前 
1 1 L Ë 制 动 /减速 


当 利用 PWM 作为 输入 控制 电动 机 时 ,其 控制 逻辑 如 表 3. 2 所 示 。 
表 3.2 PWM 模式 电动 机 控制 逻辑 表 


xINI1 xIN2 功 能 

PWM 0 向 前 PWM ,快速 停止 
1 PWM 向 前 PWM ,缓慢 减速 
0 PWM 反 转 PWM ,快速 停止 

PWM 1 反 转 PWM ,缓慢 减速 


这 里 设置 TB6612FNG 工作 在 PWM 输入 模式 ,通过 两 路 PWM 信和 号 的 输入 来 实现 电 
动机 正 反 转 及 调 速 控 制 , 其 原理 图 如 图 3. 15 所 示 。 


TB6612FNG 
图 3.15 电动 机 驱动 电路 图 


40 ll 智能 平衡 移动 机 器 人 (MATLAB/Simulink 版 ， 微 课 视频 版 ) 


图 3. 16 是 电动 机 驱动 板 接口 原理 图 。 通 过 AB 输入 端口 GPIO 输出 的 高 低 组 合 切 换 
不 同 的 驱动 电压 ,用 于 在 后 期 实验 时 观察 驱动 电压 对 驱动 效果 的 影响 。 

电动 机 驱动 还 包含 电动 机 编码 盘 的 测速 信号 读 取 ,编码 器 是 一 种 将 角 位 移 或 者 角速度 
转换 成 一 连 串 电 数 字 脉 冲 的 旋转 式 传 感 器 。 应 用 较 多 的 编码 器 主要 是 增 量 式 编码 器 和 绝对 
式 编码 器 ,二 者 的 区 别 在 于 数据 的 信号 处 理 有 所 不 同 ,其 次 根据 其 检测 原理 有 更 加 细致 的 划 
分 ,比如 利用 光电 效应 的 编码 器 以 及 利用 磁场 原理 的 霍 尔 编码 器 ,如 图 3. 17 所 示 。 


TB6612 


TB6612 GND | í 
图 3.16 驱动 板 接口 原理 图 图 3.17 霍 尔 编码 器 示意 图 


本 方案 采用 的 是 增 量 式 霍 尔 编码 器 ,通过 AB 两 相 正 交 的 方 波 脉冲 来 传递 直流 电动 机 
的 方向 以 及 位 置信 号 ,AB 两 路 信号 的 相位 差 经 逻辑 电路 处 理 后 可 以 判断 转动 方向 ,而 通过 
对 方 波 个 数 的 计数 可 以 得 到 电动 机 位 置 ,电动 机 速度 的 判断 借助 定时 器 的 中 断 功能 配合 编 
码 器 的 输出 脉冲 信号 来 完成 ,具体 方法 是 使 用 定时 器 规定 检测 周期 ,将 周期 内 的 脉冲 个 数 作 
为 速度 的 代替 值 。 

将 电动 机 编码 器 AB 相信 号 引入 eQEP 模块 ,其 接口 电路 如 图 3. 18 所 示 。 其 中 AOL, 
AO2 为 TB6612FNG 的 输出 信号 ,5V 用 于 给 霍 尔 编码 器 供电 ,AB 两 路 的 编码 器 信号 线 接 
A QEPA 和 QEPB 接口 。 


Header 6 Header 6 
图 3.18  eQEP 功能 接口 原理 图 


3.5 直流 电动 机 驱动 H 桥 电 路 


如 图 3. 19 所 示 为 一 个 典型 的 直流 电动 机 控制 电路 。 以 “H 桥 式 驱动 电路 ?为 名 是 因为 
它 的 形状 酷似 字母 H, 4 个 三 极 管 组 成 H 的 4 条 垂直 腿 , 而 电动 机 就 是 H 中 的 横 杠 。 如 
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图 3. 20 所 示 ,H 桥 式 电 动机 驱动 电路 包括 4 个 三 极 管 和 一 个 电动 机 。 要 使 电动 机 运转 , 必 
须 导 通 对 角 线 上 的 一 对 三 极 管 。 根 据 不 同 三 极 管 对 的 导 通 情况 ,电流 可 能 会 从 左 至 右 或 从 
右 至 左 流 过 电动 机 ,从 而 控制 电动 机 的 转向 。 


Qi Q; Qi Q3 
ZN 
NC 

Q; Q4 Q: Q. 

图 3.19 直流 电动 机 控制 电路 图 3.20 HH 桥 电 路 驱动 电动 机 顺 时 针 转 动 


要 使 电动 机 运转 ,必须 使 对 角 线 上 的 一 对 三 极 管 导 通 。 例 如 ,如 图 3.20 所 示 , 当 Q, E 
和 Q, 管 导 通 时 ,电流 就 从 电源 正极 经 Qi 从 左 至 右 穿 过 电动 机 ,然后 再 经 Qi 回 到 电源 负 
极 。 如 图 3.20 中 电流 箭头 所 示 ,该 流向 的 电流 将 驱动 电动 机 顺 时 针 转 动 。 当 三 极 管 Q, 和 
Q, 导 通 时 ,电流 将 从 左 至 右 流 过 电动 机 ,从 而 驱动 电动 机 按 特定 方向 转动 (电动 机 周围 的 箭 
头 指示 为 顺 时 针 方向 ) 。 图 3. 21 所 示 为 另 一 对 三 极 管 Q 和 Q, 导 通 的 情况 ,电流 将 从 右 至 
左 流 过 电动 机 。 当 三 极 管 Q 和 Q, 导 通 时 ,电流 将 从 右 至 左 流 过 电动 机 ,从 而 驱动 电动 机 
沿 另 一 方向 转动 (电动 机 周围 的 箭头 表示 为 逆 时 针 方 向 )。 

使 能 控制 和 方向 逻辑 驱动 电动 机 时 ,保证 H 桥 上 两 个 同 侧 的 三 极 管 不 会 同时 导 通 非常 
重要 。 如 果 三 极 管 Qi 和 Q, 同时 导 通 ,那么 电流 就 会 从 正极 穿 过 两 个 三 极 管 直 接 回 到 负 
极 。 此 时 ,电路 中 除了 三 极 管 外 没有 其 他 任何 负载 ,因此 电路 上 的 电流 就 可 能 达到 最 大 值 
(该 电流 仅 受 电 源 性 能 限制 ) ,甚至 烧 坏 三 极 管 。 基 于 上 述 原因 ,在 实际 驱动 电路 中 通常 要 用 
硬件 电路 方便 地 控制 三 极 管 的 开关 。 如 图 3.22 所 示 就 是 基于 这 种 考虑 的 改进 电路 , 它 在 基 
本 H 桥 电 路 的 基础 上 增加 了 4 个 与 门 和 2 个 非 门 。4 个 与 门 同一 个 “使 能 ” 导 通 信号 相 接 ， 
这 样 ,用 这 一 个 信号 就 能 控制 整个 电路 的 开关 。 而 2 个 非 门 通过 提供 一 种 方向 输入 ,可 以 保 
证 任何 时 候 在 H 桥 的 同 侧 腿 上 都 只 有 一 个 三 极 管 能 导 通 。 与 本 节 前 面 的 示意 图 一 样 ,如 
图 3. 22 所 示 不 是 一 个 完整 的 电路 图 ,特别 是 图 中 与 门 和 三 极 管 直 接连 接 是 不 能 正常 工 
作 的 。 


Q, Q; 


© 


Q; Q. 


DIR-L DIR-R 


图 3.21 fH 桥 电路 驱动 电动 机 逆 时 针 转 动 图 3.22 具有 使 能 控制 和 方向 逻辑 的 H 桥 电路 
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采用 以 上 方法 ,电动 机 的 运转 就 只 需要 用 3 个 信号 控制 : 2 个 方向 信号 和 1 个 使 能 信 
号 。 如 果 DIR-L 信号 为 0,DIR-R 信号 为 1, 并 且 使 能 信号 是 1, 那 么 三 极 管 Qi 和 Q, 导 通 ， 
电流 从 左 至 右 流 经 电动 机 (如 图 3. 23 所 示 ); 如 果 DIR-L 信号 变 为 1, 而 DIR-R 信号 变 为 
0, 那 么 Q; 和 Q, 将 导 通 ,电流 则 反 向 流 过 电动 机 。 


图 3.23 使 能 信号 与 方向 信号 的 使 用 


实际 使 用 的 时 候 , 用 分 立 元 件 制作 H 桥 电路 是 很 麻烦 的 ,好 在 现在 市 面 上 有 很 多 封装 
好 的 H 桥 集成 电路 , 接 上 电源 、 电 动机 和 控制 信号 就 可 以 使 用 了 ,在 额定 的 电压 和 电流 内 使 
用 非常 方便 可 靠 。 常 用 的 有 L293D.L298N.TA7257P.SN754410 等 。 


3.6 传感器 与 外 设 模块 


主要 用 到 的 传感器 包括 陀螺 仪 加 速度 计 传 感 器 .超声波 传感器 .蓝牙 通信 模块 及 线性 摄 


3.6.1 基于 辽 紧 仪 与 加 速度 计 的 姿态 测量 


智能 平衡 式 移动 机 器 人 的 一 大 特性 便 是 在 自 不 稳定 的 条 件 下 保持 平衡 ,而 维持 平衡 是 
通过 检测 车 身 倾 角 而 调整 电动 机 转速 与 转 矩 来 实现 的 ,在 这 一 过 程 中 姿态 检测 尤为 重要 ,本 
方案 使 用 的 是 Invensense 公司 的 MPU6050 系列 芯片 (如 图 3. 24 所 示 ) ,集成 了 三 轴 加 速度 
计 和 陀螺 仪 , 可 实现 对 各 个 方向 角度 和 速度 的 解 算 。 通 过 IIC 接口 可 以 进行 3 个 方向 的 加 
速度 信号 和 角速度 信号 的 读 取 。 

+Z 要 计算 出 车 体 的 倾角 ,可 以 通过 重力 加 速度 在 其 他 轴 上 产 
生 的 分 量 来 计算 出 角度 , 即 测量 X düs Y 轴 某 一 轴 向 的 加 速 
度 就 可 以 计算 出 倾角 ,因为 在 传感器 静止 水 平 的 时 候 ,X 轴 与 
Y 轴 不 会 有 输出 ,而 在 其 产生 一 定 的 倾角 时 才 会 使 重力 加 速度 
g fE X 轴 或 了 轴 上 产生 分 量 , 而 且 该 轴 倾 斜 的 角度 和 重力 分 
量 的 大 小 相关 。 所 以 只 要 利用 C 语言 中 的 atan2 (x, y) 函数 ， 
计算 X 轴 与 Z 轴 平 面 或 者 Y 轴 与 Z 轴 平 面 的 当前 方位 角 , 同 
图 3. 24 陀螺 仪 方向 示意 图 时 将 其 值 转化 为 角度 值 ,计算 方法 如 式 (3. 6) 和 式 (3.7) 所 示 。 
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Angle X —atan2(Accel Y,Accel Z) X 180/PI (3.6) 
Angle Y — atan2CAccel X,Accel Z) X 180/PI (3.7) 
但 是 这 个 角度 会 受到 车 体 运 动 加 速度 值 所 带 来 的 误差 影响 ,从 而 导致 角度 计算 的 精度 


不 够 ; 具体 分 析 如 下 : 假设 轮 式 机 器 人 的 倾角 为 8, 传感器 Z 轴 朝 上 水 平安 装 在 轮 式 机 器 人 
上 ,运动 方向 为 水 平时 候 的 了 方向 ,如 果 不 考虑 运动 时 产生 的 加 速度 值 ,加 速度 计 测 量 到 的 
Y 轴 的 值 即 为 式 (3. 8) 。 


a, =sinf X g (3.8) 


而 实际 运动 情况 下 YY 轴 的 加 速度 还 应 考虑 平衡 移动 机 器 人 的 运动 加 速度 & ,因此 得 到 
式 (3.9) 。 


a, —sinf X g + cosB X a” (3.9) 


a 代表 了 线 加 速度 与 角 加 速度 的 和 ,这 样 无 法 准确 地 计算 出 倾角 。 所 以 仅仅 是 加 速度 计 不 
足以 得 到 准确 的 结果 ,这 里 选用 的 传感器 MPU6050 还 包含 了 陀螺 仪 的 检测 单元 ,能够 输出 
三 轴 角 速度 信息 ,通过 角速度 值 ,可 以 进行 积分 得 到 角度 值 , 因 而 也 就 避免 了 加 速度 计算 角 
度 产 生 的 误差 。 假 设 在 一 个 5ms 的 定时 中 断 服 务 函 数 中 执行 式 (3. 10) 。 


Angel X — Angel X — Gyro X X 0. 005 š (3.10) 


式 中 ,Gyro_X 为 陀螺 仪 输出 的 X 轴 方 向 的 角速度 。MPU6050 输出 的 陀螺 仪 的 原始 数据 是 
一 32 768—32 768, 可 以 根据 式 (3. 11) 转 换 成 以 (*)/s 为 单位 。 


Gyro X —Gyro X/k (3; 112 


其 中 ,& 和 初始 化 时 的 量程 有 关 , 可 以 在 MPU6050 的 手册 中 查 到 , 20509] 16 45 A + 2000" /s 
时 ,k= 二 16.4, 如 图 3. 25 所 示 。 


6.1 Gyroscope Specifications 
VDD = 2.375V-3.46V, VLOGIC (MPU-6050 only) = 1.8V+5% or VDD, TA= 25°C 


° 

° 

"is 

*s 

Gyroscope ADC Word Length 16 bits 
Sensitivity Scale Factor FS SEL-0 131 LSB/CIS) 
FS SEL-1 655 LSBs) 
FS SEL-2 328 LSB/C/s) 
FS SEL-3 164 LSBICIS) 


图 3.25 MPU6050 量程 设置 (数据 手册 截图 ) 


但 积分 运算 在 不 断 累 加 的 过 程 中 很 容易 积累 误差 ,而 角速度 信号 会 在 干扰 等 情况 下 产 


生 一 些微 小 的 偏差 ,如果 经 过 积分 运算 ,就 会 使 得 偏差 增 大 ,从 而 使 得 信号 失真 ,就 算 传感器 
静止 放置 ,通过 积分 运算 得 出 的 角度 值 ,经 观察 也 很 可 能 呈现 随时 间 增 加 的 情况 ,所 以 仅 使 
用 陀螺 仪 数据 ,无 法 得 到 准确 的 角度 。 另 一 种 方法 是 将 两 种 测量 数据 通过 数学 方法 相 融 合 
得 到 最 终 的 值 ,常用 的 方法 有 以 加 权 平 均 为 原理 的 一 阶 互 补 滤波 ,高 级 的 方法 有 卡尔 曼 滤 
波 。 互 补 滤波 具体 实现 见 式 (3. 12)。 


Angle —£, X Angle m+ (1 — £4) X (Angle + Gyro_m X dt) (3. 12) 
Angle 是 融合 后 的 角度 值 ,Angle_m 是 加 速度 测量 得 到 的 角度 , Angle + Gyro. m X dt 
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是 陀螺 仪 积分 得 到 的 角度 ,dt 为 采样 周期 ,单位 是 s。k| 是 滤波 器 系数 ,这 里 选取 0.02, 

下 面 通过 一 个 实验 来 对 比 3 种 测量 方法 的 实际 效果 ,将 安装 了 MPU6050 的 机 器 人 在 
桌面 上 直立 ,然后 轻 轻 拍打 桌面 。 将 计算 值 通过 串口 输出 到 上 位 机 ,通过 上 位 机 可 以 观察 到 
3 条 曲线 ,如 图 3. 26 所 示 。 其 中 顶部 是 通过 陀螺 仪 积 分 获得 的 角度 ,折线 是 加 速度 计 测 量 
的 角度 ,折线 所 包含 的 是 两 者 通过 算法 融合 得 到 的 角度 。 

— WCG RUE TF EGER 
一 加 速度 计 测量 值 
陀螺 仪 积分 值 _ 


测 得 角度 值 /(*) 


12 14 16 18 20 


0 2 4 6 8 


T 
图 3.26” 数 据 采 集 效果 对 比 

可 以 看 到 ,陀螺 仪 积分 得 到 的 角度 因为 自身 的 零点 漂移 ,误差 随 着 时 间 变 化 在 每 一 个 时 
间 周 期 中 逐步 增加 ,误差 越 来 越 大 ,最 终 偏 离 真实 值 。 加 速度 计 测量 的 角度 信号 在 受到 外 界 
干扰 的 情况 下 ,会 有 很 大 的 毛刺 。 而 通过 算法 融合 得 到 的 角度 值 则 非常 稳定 ,变化 范围 也 很 
小 。 数 据 融 合 的 要 点 在 于 ,将 加 速度 计 及 陀螺 仪 两 种 传感器 的 固有 弱点 相互 抵消 ,加 速度 计 
容易 采集 到 的 某 一 时 刻 加 速度 的 瞬时 值 , 而 陀螺 仪 的 积分 会 放大 温度 漂移 静态 误差 ,瞬时 值 
需要 通过 滤波 器 过 滤 掉 ,而 陀螺 仪 的 误差 不 能 够 被 长 时 间 的 积分 反复 累计 ,所 以 需要 互补 滤 
波 器 来 实现 加 速度 计 对 陀螺 仪 计 算 角 度 的 纠正 ,将 陀螺 仪 测 得 的 数据 作为 主要 的 计算 依据 ， 
由 于 加 速度 计 会 将 运动 速度 计 入 因而 不 够 精确 ,但 是 在 每 个 循环 周期 反复 积分 时 给 其 一 定 
的 比重 ,就 能 够 矫正 偏差 的 累计 ,最 终 得 到 相对 精确 的 测量 值 。 硬 件 上 ,MPU6050 模块 通 
it IC 接口 与 主 控 芯 片 进行 通信 ,该 模块 采用 市 面 通用 的 8 引 脚 直 插 模块 ,方便 维修 更 换 ， 
传感器 电路 以 及 接口 电路 如 图 3. 27 所 示 ,由 于 其 电路 中 设计 了 稳 压 模块 ,输入 电压 可 以 为 
3. 3 一 5V, 这 里 接 人 5V , AD0 是 当 总 线 连接 了 多 个 IIC 从 设备 时 ,通过 该 位 来 为 从 机 选择 一 
个 地 址 。 当 MPU6050 设置 为 从 机 模式 的 时 候 , 通 过 ADO 位 来 选择 8 位 地 址 中 的 最 低位 ， 
其 余 7 位 是 固定 的 0x68, 由 WHO AM I 寄存 器 决定 ,XCL 引 脚 与 XDA 引 脚 为 MPU6040 
作为 主机 时 候 的 时 钟 线 与 数据 线 , 本 书 的 方案 中 TIC 设备 仅 有 MPU6050 ,并 且 工 作 在 从 机 
模式 ,因而 接口 电路 只 需要 连接 电源 和 地 ,另外 连接 TIC 接口 的 SCL 与 SDA 引 脚 即 可 ,INT 
为 中 断 引 脚 ,这 里 没有 用 到 ,保持 悬空 。 
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DI 


VCC 5V Q2 VCC 3.3V 


R201 


NC 
VCC 33V 
— * 


MPU6050 
图 3.27 陀螺 仪 模 块 原理 图 及 接口 电路 


3.6.2 蓝牙 通信 模块 


acral do ç Rech 蓝牙 串口 采用 的 是 德州 仪器 的 CC2541 系 
列 蕊 片 ,支持 AT 指令 , 功 耗 低 ,收发 灵敏 度 高 ,具有 宽泛 的 电源 电压 范围 ,不 使 用 外 部 前 段 
TAR KERR, a TARARES 0 协议 快速 地 与 手机 、 计 算 机 等 设备 建立 连接 ,从 而 接 
收 串 行 数据 ,实现 远程 遥控 。 使 用 成 熟 模块 时 , 仅 需 要 将 串口 SCIA 的 两 个 引 脚 与 模块 相 
连 , 如 图 3. 28 所 示 。 
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Pl 


Header 6 


图 3.28 蓝牙 串口 接口 与 实物 图 


3.6.3 OLED 显示 模块 


OLED 即 有 机 发 光 二 极 管 (Organic Light-Emitting Diode), 又 称 为 有 机 电 激 光 显 示 
(Organic Electroluminesence Display,OELD)。OLED 由 于 同时 具备 自发 光 ,不 需 背 光源 、 
对 比 度 高 .厚度 薄 、 视 角 广 , 反 应 速度 快 、 可 用 于 挠 曲 性 面板 、 使 用 温度 范围 广 、 构 造 及 制程 较 
简单 等 优点 ,被 认为 是 下 一 代 的 平面 显示 器 新 兴 应 用 技术 。OLED 显示 技术 具有 自发 光 的 
特性 ,采用 非常 薄 的 有 机 材料 涂 层 和 玻璃 基板 , 当 有 电流 通过 时 ,这 些 有 机 材料 就 会 发 光 , 而 
H OLED 显示 屏幕 可 视角 度 大 ,并 且 能 够 节省 电能 。OLED 模块 接口 实物 图 和 显示 屏 如 
图 3.29 所 示 。 — — — — — FP<z=əEKEE - 

OLED 模块 的 8080 接口 方式 需要 如 下 一 些 EESEIENG 
信和 号 线 。 

* CS; OLED FARS, 

。 WR: 向 OLED 写 入 数据 。 

* RD: 从 OLED 读 取 数据 。 [I i1 

° D[7: 0]: 8 位 双向 数据 线 。 图 3. 29 OLED 模块 接口 实物 图 

* RST(RES); 硬 复位 OLED, 

。DC: 命令 /数据 标志 (0, 读 写 命令 ; 1, 读 写 数 据 ) 。 


3.7 本章 小 结 


本 章 根据 智能 平衡 式 机 器 人 平台 的 特性 与 应 用 要 求 ,提出 统一 硬件 接口 标准 、 模 块 化 拱 
接 实现 平台 的 硬件 系统 设计 。 主 要 完成 的 任务 包括 以 下 方面 。 

。 集成 仿真 器 的 主 控制 板 电路 与 硬件 设计 。 

。 用 于 多 个 设备 独立 供电 的 电源 管理 板 电 路 与 硬件 设计 。 

° 可 调节 驱动 电压 的 电动 机 驱动 板 电 路 与 硬件 设计 。.， 

。 陀螺 仪 加 速度 计 、 蓝 牙 .OLED 显示 在 内 的 传感器 与 外 设 模块 电路 与 硬件 设计 。 


— 数字 控制 系统 


CHAPTER 4 


本 章 将 开始 进行 智能 平衡 式 机 器 人 的 控制 器 设计 ,由 于 智能 平衡 式 机 器 人 的 自 不 稳定 
性 ,控制 起 来 可 以 类 比 于 一 级 倒立 摆 系 统 , 因 而 可 以 借鉴 相关 的 控制 方法 ,常见 的 方法 有 反 
馈线 性 化 方法 , 除 此 之 外 ,还 有 非 线 性 PID 控制 自 适应 控制 与 自 抗 扰 控制 ; 后 来 也 有 研究 提 
出 传统 方法 缺乏 对 外 界 干扰 和 参数 改变 的 鲁 棒 性 能 ,提出 对 于 参数 变化 和 干扰 都 无 法 产生 
控制 效果 影响 的 滑 模 变 结构 控制 ,本 章 考 虑 到 使 用 MATLAB/Simulink 模型 直接 生成 控制 
代码 ,为 减少 控制 的 复杂 程度 与 提高 代码 的 效率 ,采用 较为 简单 的 双 闭 环 PID 控制 思想 来 
具体 实现 平衡 模型 。 首 先 分 析 系 统 的 平衡 控制 ,整个 系统 通过 陀螺 仪 加 速度 计 传 感 器 的 数 
据 计 算 角 度 ,根据 编码 器 信和 号 计算 速度 信息 ,将 角度 和 速度 作为 系统 输入 量 提供 给 控制 芯片 
并 计算 出 电动 机 的 控制 量 , 最 后 以 PWM 信和 号 的 方式 输出 给 驱动 芯片 ,驱动 执行 部 件 一 一 有 
刷 电动 机 进行 运动 。 如 图 4. 1 所 示 ,基础 平衡 量 由 角度 偏差 值 计算 得 到 ,但 平衡 量 不 足以 维 
持平 衡 , 故 加 入 速度 控制 量 与 转向 控制 量 ,三 者 线性 盔 加 得 到 最 终 的 电动 机 P W M 控制 量 进 
行 输出 。 


六 轴 运 动 处 理 传 感 顷 


直流 电动 机 编码 器 信号 | 


图 4.1 控制 流程 框图 


4.1 数字 信号 处 理 器 介绍 


4.1.1 TMS320F28069 芯片 特点 


1. 高 效率 32 位 浮 点 CPUCTMS320F28069) 
。 Hi 90MHz(11. 11ns 周期 时 间 ) 。 
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° 16X16 和 32X32 MAC 运算 。 

16X16 双 通 道 MAC, 

哈佛 (Harvard) 总 线 架 构 联 动 运算 。 

。 快速 中 断 响应 及 处 理 统 一 内 存 编程 模型 。 

° 高 编码 效率 (采用 C/C++ 语言 和 汇编 语言 )。 

2. 浮 点 单元 ,具有 本 地 单 精度 浮 点 运行 功能 

。 可 编程 控制 确认 加 速 器 (CLA)32 位 浮 点 数学 加 速 器 。 
。 代码 执行 不 依赖 于 主 CPU. 

3. 数学 校 验 

e Viterbi 复杂 数学 循环 校 验 单元 (VCU ) 。 

。 对 C28x 指令 集 进行 了 扩展 以 支持 复数 乘法 。 

° Viterbi 运算 及 循环 元 余 校 验 CCRC) 。 

4. NX RE 

高 达 256KB 内 存 。 

。 容量 高 达 100KB 的 RAM2KB 的 OTPROM, 

* 6 通道 DMA, 

5, 供电 

。 仅 需 单 电源 3. 3V 供电 。 

° 无 电源 上 电 顺 序 要 求 。 

。 内 部 集成 上 电 复 位 和 欠 压 复位 低 功 耗 操作 模式 。 
6. 时 钟 

。 无 需 外 部 晶振 ,内 部 集成 了 两 个 独立 的 振荡 器 ,每 个 振荡 器 频率 为 10MHz。 
。 单 片 晶 体 振荡 器 /外 部 时 钟 输入 。 

。 支持 动态 PLL 比率 改变 。 

。 看 门 狗 定时 器 模块 时 钟 丢失 检测 电路 。 

7. 中 断 

。 可 支持 所 有 外 设 中 断 的 外 设 中 断 扩展 (PIE) 模 块 。 
。 支持 3 路 外 部 输入 中 断 信号 。 

e GPIO0—GPIO31 均 可 配置 为 外 部 输入 引 脚 。 
。3 个 32 位 CPU 定时 器 。 

。 Zik 8 个 增强 型 脉 宽 调制 器 (ePWMD 模 块 。 

* 总 共 16 个 PWM 通道 [其 中 有 8 路 能 够 支持 高 分 辨 率 PWM(CHRPWM) 通 道 ]。 
。 每 个 模块 中 由 独立 的 16 位 定时 器 。 

8. 多 类 功能 模块 

。 3 个 输入 捕获 (eCAP) 模 块 。 

。 4 个 高 分 辩 率 输入 捕获 (HRCAP) 模 块 。 
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。 2 个 正 交 编码 器 (eQEP) 模 块 。 

。 16 通道 12 位 ADC, 双 通道 采用 以 及 保持 采样 率 高 达 3MSPS。 

。 如 果 选 择 内 部 3. 3V 参考 源 ,输入 电压 为 0 一 3. 3V。 
9. 片上 温度 传感器 

° 128 位 安全 密 钥 / 锁 用 于 保护 安全 内 存 块 。 

。 可 保护 固件 逆向 工程 。 

10. 串 行 端口 外 设 

。 两 个 串 行 通信 接口 (SCI) 模 块 、 两 个 串 行 外 设 接口 (SPI) 模 块 。 

。 一 根 内 置 集成 电路 (IIC) 总 线 。 

。 一 根 多 通道 缓冲 串 行 端口 (MecBSP) 总 线 .一 个 增强 型 控制 器 局 域 网 (eCAN ) 。 


4.1.2 处 理 器 引 脚 及 功能 


TMS320F28069 分 为 80 引 脚 和 100 引 脚 两 种 ,平衡 移动 机 器 人 控制 板 采用 100 引 脚 形 
式 , 由 于 引 脚 复 用 ,因此 所 有 外 设 不 可 同时 使 用 , 引 脚 及 功能 框图 见 本 书 配套 资料 。 


4.2 控制 系统 简介 


首先 分 析 模 型 来 确定 控制 原理 ,简化 机 械 模型 如 图 4. 2 所 示 。 
假设 整体 质量 为 M ,中 心 距 离 车 轴 高 度 约 为 工 , 相 对 垂 
直面 倾斜 角度 为 0, 运动 加 速度 为 C ,同时 车 身 有 个 角 加 
速度 下 (1) ,可 以 分 析 其 受 力 方程 如 式 (4.1) 所 示 。 
d^8) 
L > 
dt^ 


F(t) 


— gsinü (t) — a(t)cos0 (1) + L * F(t) 


(4.1) 
在 接近 平衡 的 时 候 , 角 度 0 可 以 认为 很 小 ,因此 可 以 将 sindi) 
和 cosb(t) 简 化 为 式 (4. 2) 。 


2 
O grua) +L * FG (4, 2) 

了 

图 4.2， 轮 式 平衡 移动 机 器 人 
当 平台 趋 于 静止 平衡 的 时 候 ,加 速度 应 该 为 0, 此 时 ， aic 

2 
L HP =g *sinñG) +L * FG) (4.3) 

x 

对 应 可 以 求 出 系统 传递 函数 : 
0Cs) 1 
T cci a E (4.4) 
“E 


由 上 面 的 公式 可 以 知道 ,该 系统 一 共有 两 个 极点 ,分 别 为 士 Vg 工 ,但 是 根据 奈 奎 斯 特 判 
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据 ,其 中 一 个 极点 位 于 s 平面 的 右 半 面 会 引起 系统 的 不 稳定 性 ,为 了 消除 这 种 情况 ,可 以 采 
用 加 入 反馈 环节 的 方法 ,能 够 有 效 避 免 闭 环 过 程 中 的 参数 波动 所 产生 的 扰乱 系统 控制 效果 
的 影响 ,同时 能 够 减 小 系统 时 间 常 数 和 非 线 性 的 影响 。 反 馈 控 制 器 可 以 是 PI, 可 以 是 PD, 
也 可 以 是 PID, 这 里 考虑 到 角度 控制 环节 中 ,由 于 角度 信息 由 陀螺 仪 加 速度 计 采 集 , 这 类 惯 
性 测量 仪器 容易 有 信号 噪声 和 零点 漂移 ,为 了 防止 这 些 误差 被 积分 环节 进一步 扩大 ,因而 决 
定 引 入 比例 和 微分 反馈 。 此 时 系统 如 图 4.3 所 示 。 


图 4.3 比例 微分 控制 系统 


系统 传递 函数 变 为 式 (4.5) 的 形式 。 
0s) 1 


HO =F i E p (4.5) 
s TIS L 
此 时 系统 的 两 个 极点 可 表示 为 式 (4.6) 的 形式 。 
—k, + ki — 4L (k; — g) 
s cra sg LO ca (4.6) 


2L 
从 式 (4.6) 可 知 , 当 有 Ri 之 5, 二 0 时 ,满足 两 个 极点 位 于 平面 左 半 平面 的 稳定 条 件 ， 
在 整个 角度 环 路 中 ,; 5 k, 的 阶 分 别 代表 了 角度 与 角速度 ,因此 可 以 得 出 结论 ,控制 平衡 
的 控制 量 由 角度 与 角速度 计算 而 来 。 由 于 控制 器 的 离散 特性 ,需要 将 以 上 结论 进行 另 一 种 
形式 的 转化 。 我 们 通过 直接 分 析 其 平衡 规律 也 可 以 得 到 同样 的 结论 ,首先 因为 产生 倾角 进 
而 产生 控制 量 ,前 倾 的 时 候车 轮 也 要 向 前 运动 ,后 倾 则 车 轮 向 后 ,所 以 认为 电动 机 控制 量 与 
倾角 之 间 存 在 比例 关系 如 式 (4.7)。 
xr —k0 (4. 7) 
但 是 当 0 为 0 时 ,按照 式 (4.7) 控 制 量 > 也 为 0, 此 时 由 于 绕 轴 的 转动 惯量 的 存在 而 产 
生 的 惯性 使 得 车 体 并 不 能 维持 这 种 平衡 状态 ,需要 引入 一 种 阻尼 力 来 保持 平衡 ,这 时 候 便 可 
引入 一 个 与 角速度 相关 的 阻尼 器 ,控制 量 的 计算 变 为 式 (4. 8) 的 形式 。 
x —h0--k,0 (4. 8) 
同样 可 以 得 到 这 样 一 个 PD 控制 器 ,其 控制 原理 如 图 4. 4 所 示 。 


welt 
—& | PD 控制 器 轮 式 机 器 人 
角度 与 角速度 反馈 


图 4.4 udi dii H E 
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4.3 系统 控制 器 


4.3.1 速度 控制 器 


在 保持 平衡 的 前 提 下 做 速度 控制 是 一 件 较为 复杂 的 事 , 因 为 改变 速度 的 同时 不 能 影响 
基本 的 平衡 控制 , 故 不 能 将 速度 的 控制 效果 直接 加 到 电动 机 速度 的 改变 中 去 ; 因此 ,为 了 简 
化 控制 量 与 控制 结果 之 间 的 关系 ,我们 将 速度 控制 看 作 是 与 角度 相关 的 平衡 控制 的 外 环 控 
制 ,即将 直立 控制 的 目标 值 看 作 是 速度 控制 的 结果 ,因为 倾角 决定 了 速度 ,向 前 倾斜 的 程度 
与 轮 式 机 器 人 在 该 方向 上 的 运动 速度 是 正 相 关 的 ,由 于 倾角 的 存在 导致 平衡 控制 中 的 偏差 存 
在 ,因而 需要 加 速 去 消除 倾角 的 存在 从 而 维持 平衡 状态 。 从 上 述 分 析 中 可 以 得 到 如 图 4.5 所 
示 的 控制 原理 图 。 


速度 设 定 值 


直立 平衡 闭环 
Failas 


角度 与 角速度 反馈 
速度 反馈 
图 4.5 速度 控制 器 原理 图 


这 里 的 速度 反馈 主要 是 利用 编码 器 信号 由 eQEP 功能 模块 的 读 取 实 现 , 由 图 4.5 可 以 
看 出 ,原先 直立 平衡 中 的 输入 量变 成 了 速度 控制 的 输出 量 , 由 此 形成 一 个 串 级 控制 系统 ,由 
于 前 面 平 衡 控 制 器 采用 的 是 PD 控制 ,这 里 为 了 消除 系统 的 静态 误差 ,提高 响应 速度 以 及 抗 
扰 能 力 , 选 定 速 度 控制 右 为 PI 控制 器 。 
xc—kQ*(—2r)) 0k x*0 ' (4.9) 
xı =k, *e(k)+k, * Pe) (4.10) 
其 中 , 式 (4.9) 为 直立 平衡 控制 R. 10) 为 速度 控制 ,0 代表 角度 ,0 代表 角速度 ,e(CR) 是 实 
际 速度 与 设 定 速度 的 偏差 ,偏差 求 和 代表 积分 ,可 见 两 式 可 以 进行 结合 ,从 而 达到 简化 系统 
的 目的 ,将 式 (4.10) 代 入 式 (4.9), 可 得 出 式 (4. 11)。 
xz =k 9 + kab’ — k Ek ek) Hki Dyelk)] (4.11) 
青 由 式 (4.11), 可 以 看 出 两 者 的 控制 可 以 进一步 拆 分 为 一 个 负 反 馈 的 角度 控制 与 正 反 
REMAR, WE 4.6 所 示 。 
给 定 角度 给 束 


ENF p 速度 闭环 控制 器 


陀螺 仪 信息 编码 器 信息 


轮 式 机 器 人 


图 4.6 全 加 控制 原理 图 
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4.3.2 方向 控制 器 


由 于 智能 平衡 式 机 器 人 特有 的 两 轮 同 轴 的 机 械 特性 ,导致 其 方向 控制 主要 来 自 两 轮 的 
差 速 控制 。 在 只 有 平衡 控制 和 速度 控制 且 没有 外 部 传感器 的 情况 下 , 想 让 改 底盘 结构 保持 
走 直线 是 一 个 比较 难 的 问题 ,而 对 轮 式 机 器 人 而 言 ,我 们 在 平衡 控制 和 速度 控制 的 基础 上 ， 
加 上 一 个 转向 控制 ,就 能 够 使 得 它 保持 短 距离 的 直线 行驶 ,而 转向 控制 是 建立 在 直立 平衡 控 
制 和 速度 控制 的 基础 之 上 的 ,不 能 影响 正常 的 直立 平衡 控制 。 这 里 主要 实现 平衡 控制 ,对 于 
转向 的 精度 要 求 不 高 ,对 于 转向 环 可 以 使 用 P( 比 例 ) 控 制 器 或 者 P( 比 例 )D( 微 分 ) 控 制 器 ， 
由 于 转向 环 主要 起 辅助 作用 ,不 需要 过 高 的 响应 速度 ,所 以 采用 比例 控制 即 可 。 方 案 主 要 是 
使 用 Z 轴 陀 螺 仪 的 角速度 数据 与 设 定 的 目标 转向 角速度 做 偏差 来 计算 控制 量 进行 P 控制 ， 
其 避免 了 通过 车 轮 编码 器 信号 来 判断 转向 时 无 法 考虑 打滑 的 缺点 以 及 陀螺 仪 数据 用 于 计算 
转向 角 时 可 能 产生 的 误差 累积 情况 ,采用 瞬时 的 读数 判断 偏差 ,优点 是 算法 简单 ,但 也 存在 
对 高 频 信 号 采样 失真 的 缺点 。 对 本 书 中 设计 的 智能 平衡 式 机 器 人 而 言 ,平衡 角度 环 与 速度 
环 是 保持 平衡 的 关键 ,因而 响应 速度 要 求 必 须 足 够 高 ,否则 无 法 实现 平衡 的 任务 。 而 转向 环 
的 作用 是 在 平衡 移动 机 器 人 行驶 的 过 程 中 ,在 保持 平衡 的 基础 上 跟随 给 定 的 Z 轴 角 速度 ， 
因此 ,可 以 通过 实验 证 明 设 定 Z 轴 目 标 角 速度 为 零 能 否 保持 机 器 人 直线 运动 ,这 个 直线 精 
度 受 到 的 影响 很 多 ,但 不 妨碍 基础 功能 实现 ,因此 转向 环 上 的 比例 控制 器 已 经 足够 实现 预期 
的 效果 。 


4.3.3 系统 控制 框架 


本 节 将 提出 一 种 可 拓展 性 的 轮 式 机 器 人 平台 系统 设计 ,考虑 例如 CD 摄像 头 循 迹 .App 
控制 与 超声 波 避 障 等 拓展 功能 ,实现 整体 控制 效果 ,体现 平台 属性 。 控制 流程 主要 分 以 下 
3 部 分 。 

1. 系统 初始 化 

进行 系统 中 断 的 配置 ,全 局 中 断 的 开启 ,1/0O 口 初始 化 ,PWM 初始 化 ,QEP 初始 化 ,IIC 
通信 的 初始 化 以 及 MPU6050 的 初始 化 ,最 后 打开 Timer0 的 中 断 及 串口 中 断 。 

2. 串口 中 断 程 序 

设计 串口 中 断 程序 ,可 以 实现 诸如 App 控制 和 参数 下 载 ,模式 切换 等 拓展 功能 ,根据 蓝 
牙 串 口 接收 到 的 指令 ,用 于 实现 设置 相应 的 如 前 进 、 转 向 、 调 速 , 停 止 等 运动 执行 标志 位 以 及 
模式 切换 的 功能 ,运动 执行 标志 位 作为 速度 控制 量 或 转向 控制 量 计算 时 的 参考 ,实现 基本 的 
运动 控制 以 及 系统 启 停 ; 模式 切换 用 于 主 中 断 中 选择 算法 的 执行 种 类 ,实现 不 同 功能 及 情 
景 上 的 运动 控制 。 

3. 主 中 断 程序 

主要 中 断 流 程 设计 如 图 4.7 所 示 。 系 统 主要 程序 的 运行 需要 精确 的 时 钟 周期 来 保证 平 
衡 控 制 的 稳定 运行 ,这 里 用 到 的 是 单片机 的 定时 Timer0 来 实现 5ms 为 周期 的 陀螺 仪 信号 
读 取 、 编 码 器 信号 读 取 、.PWM 控制 量 的 计算 、 启 停 信号 的 检测 以 及 摄像 头 信号 的 读 取 和 中 
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线 值 计算 的 过 程 。 蓝 牙 串口 发 送 来 的 控制 信号 通过 串口 中 断 接收 ,在 速度 控制 量 计算 时 介 
人, 定 速 自主 循 迹 则 通过 图 像 采 集 模 块 得 到 的 电压 值 进行 中 线 识别 ,根据 转向 控制 量 计 算出 
两 轮 的 电动 机 差 速 PWM 控制 量 ,自主 循 迹 与 App 控制 两 种 模式 不 同时 执行 。 进 入 定时 器 
中 断 程序 后 ,首先 是 读 TIC 接口 的 陀螺 仪 角度 及 角速度 数据 ,用 于 后 面 平衡 控制 量 的 计算 ， 
读 取 QEP 接口 的 编码 器 信息 计算 出 速度 ,用 于 后 面 速 度 控制 量 的 计算 ,然后 判断 按键 标志 
位 或 者 蓝牙 接收 的 启动 标志 位 ,如 果 顺 利 检测 到 * 则 进行 下 面 的 模式 选择 及 控制 量 计算 。 


读 取 所 需 方向 
MPU6050 角 度 值 与 
加 速度 值 


读 取 编 码 器 信息 并 
计算 速度 值 


速 


是 否 接 收 到 启动 
指令 


平衡 、 速 度 、 转向 
控制 量 计算 


图 4.7 中 断 程序 流程 图 
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4.4 本 章 小 结 


本 章 根据 实现 平衡 的 基本 要 求 将 控制 系统 分 为 三 大 主要 控制 部 分 ,并 分 别 对 其 进行 了 
理论 分 析 、 公 式 推导 与 最 终 控制 器 的 设计 。 其 中 ,角度 平衡 控制 使 用 PD 控制 器 ; 速度 控制 
根据 串 级 控制 理论 分 析 ,作为 外 环 控制 ,使 用 PI 控制 器 ; 转向 控制 器 采用 比例 控制 ,其 作用 
是 辅助 前 两 项 控制 。 本 章 最 后 部 分 设计 了 一 种 实现 基础 平衡 控制 及 拓展 应 用 的 程序 运行 
框架 。 


基础 应 用 


CHAPTER 5 


本 章 主 要 介绍 智能 平衡 移动 机 器 人 TMS320F28069 片 内 外 设 的 使 用 ,了 解 片 内 外 设 的 
基本 原理 ,并 结合 MATLAB/Simulink 实现 TMS320F28069 单片机 外 设 的 模型 搭建 实验 环 
境 及 自动 代码 生成 。 


5,1 GPIO 


TMS320F28069 有 54 个 GPIO ,对 应 芯片 输出 的 54 个 引 脚 。 这 些 引 脚 分 为 A、B 两 组 : 
A 组 包括 GPIOO— GPIO31, B 组 包括 GPIO32 — GPIOS58, E: rh B £8 85 5| fl PR & GPIO45 一 
GPIO49 引 脚 。 每 个 引 脚 都 有 自己 的 复 用 功能 ,可 以 根据 使 用 手册 进行 配置 。 

GPIO 在 当 作 通用 1/0 口 使 用 的 时 候 , 可 以 通过 GPxDIR 配置 L/O 口 的 方向 (1 为 输 
出 ,0 为 输入 ) 。GPxMUXn 用 于 配置 GPIOn 的 复 用 功能 ,GPxPUD 用 于 配置 1⁄O 口 的 上 
拉 功 能 (0 为 使 能 上 拉 ) ,也 可 以 使 用 量化 寄存 器 GPxQSEL 对 输入 信号 进行 量化 限制 ,从 而 
消除 数字 量 L/O 引 脚 的 噪声 干扰 。 

此 外 ,还 有 4 种 方式 可 对 GPIO 引 脚 进行 读 写 操作 : 可 以 通过 GPxDAT 寄存 器 独立 
读 / 写 L/O 口 信 号 ; 使 用 GPxSET 寄存 器 写 1 对 I/O 口 进 行 置 位 操作 ; 使 用 GPxCLEAR 
寄存 器 写 1 对 L/O 口 进行 清 零 操 作 ; 使 用 GPxTOOGLE 寄存 器 写 1 对 I/O 口 进行 电 平 翻 
转 操作 。 需 要 注意 的 是 ,以 上 操作 写 0 时 均 无 效 。 


5.1.1 GPIO OUTPUT 控制 LED KJ 


作为 第 一 个 应 用 案例 ,以 “点 亮 一 个 LED 灯 ” 开 始 。 硬 件 上 的 蓝 色 LED 灯 对 应 的 引 脚 
为 GPIO31 ,与 红色 LED 灯 对 应 的 引 脚 为 GPIO25 ,如 图 5.1 所 示 。 由 于 这 两 个 LED 灯 都 
是 共 阴 连接 方式 , 当 GPIO 为 高 电 平 ( 置 1) 时 , 则 LED 灯 被 点 亮 ; 当 GPIO 为 低 电 平 ( 置 0) 
的 时 候 , 则 LED 灯 熄 灭 。 首 先 对 整个 模型 进行 配置 。 

打开 Simulink 的 模型 在 Simulation 工具 栏 下 打开 模型 配置 参数 (Model Configuration 


O 此 处 基本 配置 适用 于 所 有 模型 ,后 续 实 验 模 型 的 基本 配置 都 可 参考 本 节 设 置 。 
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Pararmeters) 界 面 或 者 直接 单 击 矿工 具 , 如 图 5.2 所 示 。 


GPIO24/ECAP1/EQEP2A/SPISIMOB Fr 
GPIO25/ECAP2/EQEP2B/SPISOMIB LED] R14 SD5 K LED green 
GPIO26/ECAP3/EQEP21/SPICLKB/USBODP 
GPIO27/HRCAP2/EQEP2S/SPISTEB/USBODM 
GPIO28/SCIRXDA/SDAA/TZ2 
GPIO29/SCITXDA/SCLA/TZ3 
GPIO30/CANRXA/EQEP2I/EPWM7A 
GPIO31/CANTXA/EQEP2S/EPWMS8A 


图 5.1 LED 灯 引 脚 连接 图 


LED2 


Elle Edit View Display Diagram Simulation Analysis Code Tools Help 


sicco oO BoE q@p s Fi: c — mnc 


图 5.2 模型 参数 配置 


首先 配置 Solver 选项 卡 ,如 图 5.3 所 示 ,设置 Stop Time 为 inf, Solver selection X% 
步 长 离散 解 算 器 ,也 就 是 Type 选择 Fixed-tep, 并 选择 discrete(no continuous states) 。 定 步 长 
设置 根据 实际 情况 确定 ,默认 为 auto, 单 位 为 秒 ,此 定 步 长 相当 于 定时 器 0 的 中 断 时 间 间 隔 。 


à Configuration Parameters: GPIO LED/Configuration (Active) 


[Q Search j 
TT simulation time 
| Data Import/Export | s 
| Math and Data Types Start time; |0.0 
| * Diagnostics | P 
| Hardware Implementation | P9 erseecton — 
Modei Raloreneng we [Frei —] 
Simulation Target | 
| * Code Generation | v Solver details 
| » Coverage | o. - 
|» HDL Code Generation | Fixed-step size fundamentalsampletme;[0.008 ] — —  — 


图 5.3 解 算 器 配置 


在 配置 过 程 中 需要 注意 的 是 , 解 算 器 类 型 必须 选择 固定 点 解 算 器 。 固 定点 Solver 中 提 
供 了 多 种 算法 ,此 模型 由 于 没有 连续 状态 ,所 以 可 以 选择 discrete 方法 。 步 长 默认 为 auto， 
在 简单 的 通用 嵌入 式 代 码 生 成 过 程 中 此 参数 没有 实际 作用 ,可 以 采用 默认 或 设置 0. 005s。 
而 在 针对 目标 芯片 定制 的 代码 生成 过 程 中 ,硬件 驱动 工具 箱 往往 会 将 步 长 step size 作为 其 
外 设 或 内 核 中 定时 器 的 中 断 周期 ,使 得 生成 的 算法 代码 在 硬件 芯片 中 以 同样 的 时 间 间 隔 执 
行 。 由 于 解 算 器 步 长 为 整个 模型 提供 了 一 个 基础 采样 频率 , 故 被 称 为 基 采 样 率 (base-rate) 。 

在 Diagonostics 选项 卡 的 Data Validity 选项 中 ,将 Multitask data store 配置 为 none。 

在 Hardware Implementation 中 选择 Hardware board 为 TI Piccolo F2806x 或 者 TI 
Piccolo F2806x(boot from flash) ,前 者 为 将 程序 烧 写 到 RAM 中 ,适合 调试 ,程序 在 芯片 掉 
电 后 丢失 ; 后 者 为 将 程序 烧 写 到 Flash 中 ,适合 运用 到 实际 应 用 中 , 掉 电 后 不 丢失 ,提供 的 
示例 模型 选择 为 后 者 。 这 时 Simulink 会 在 Device type 中 自动 选 定 TI C2000 系列 。 然 后 
配置 该 界面 下 Build action 为 Build, load and run( 默 认 )。Device Name 为 F28069。 选 中 
Use custom linker command file 复 选 框 ,如 图 5.4 所 示 。 然 后 在 Clocking 选项 中 ,外 部 晶 
振 默 认为 10MHz, 将 系统 时 钟 配 置 最 高 为 90MHz, LSPCLK 低速 时 钟 外 设 设置 为 
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SYSCLKOUT/4 分 频 , 如 图 5.5 所 示 。 其 他 外 设 模块 按 自己 需要 配置 。 


| @ Configuration Parameters: GPIO LED/Configuration (Active) 


| Q Search I 
| Soler Hardware board 
Data ImporVExport 3 
Math and Data Types Fe GN EN RECS: WU r 
» Diagnostics Device vender. Taxas Instruments. — P -— x 
| » Device details 
Model Referencing 
Simulation Target | Hardware board settings 
» Code Generation 
» Coverage * Operating system/scheduler settings 
| 1> HDL Code Generation 
* Target hardware resources 
|. [uno Buia action: [Bund la ana nn ] " 国 
| jp Device Name: [F28088 |] ° |= I Boot From 
|. [V] Use custom linker command file 
eCAN.A Linker command fis: [S(TARGET_ROOT)isrcic28069.cmd — 
ECAP CoS hardware configuration fie: (SCTARGET. ROOTYCCS Confi28068 
ew C] Enable DMA to access ePWM Registers instead of CLA 
图 5.4 硬件 配置 
@ Confiyuration Parameters: GPIO LED/Configuration (Active) - 口 x 
| see i i i 
Solver E » Orerating system/scheduler settings ^ 
Data Import/Export 
Math and Data Types * Target hardware resuur zes 
» Diagnostics 
Groups —- m - PF oer 
||. Model Referencing "cc Desired CPU Clockin MHz: [50 ] * 3 
| | Sisika aga [F Use internal osciliator 
» Code ADC. 
sassa COMP Oscillator clock (OSCCLK) frequency in Mhz: 0 — | A 
| | * HOL Code Generation eCAN A — [7| Auto set PLL based on OSCCLK and 
| | eaCAP —  — — PLL control register (PLLCR): È 
f epwM yer 
| gc Clock divider (DIVSEL) (OSCCLK ARMEER N 1 
SCIA 了 Achevable SYSCLKOUT in MHz -(OSCCLK'PLLCRyDIVSEL B 0550 
B tasoon Pets cot Pense treo O] 0000 
SPLA Low-Speed Peripheral Clock {LSPCLK) in MHz 225 C : 
SPLB — I 
图 5.5 时 钟 配 置 


在 Code Generation 选项 卡 中 使 用 的 Toolchain 为 Texas Instruments Code Composer 
(C2000), fE Code generation objectives 的 Prioritized objectives 中 将 执行 效率 ,ROM 效 
* RAM 效率 设置 为 优先 的 代码 生成 目标 ,如 图 5. 6 所 示 。 在 Report 中 选中 Generate model 
Web view 复 选 框 , 使 生成 的 代码 可 以 进行 模型 与 代码 之 间 相 互 的 跟踪 ,如 图 5.7 所 示 。 

以 上 便 完 成 了 一 个 模型 最 基本 的 配置 。 

在 Simulink 界面 上 ,搭建 点 亮 一 个 LED 灯 的 模型 ,系统 步 长 为 0.005s,Counter Limited ix 
置 Upper limit 为 400, Compare To Constant 设置 Constant value 为 200 ,将 GPIOx 选择 为 
GPIO31, 如 图 5. 8 所 示 ,LED 流水 灯 模 型 如 图 5. 9 所 示 。 | 

整个 控制 效果 为 : 当 计数 值 大 于 或 等 于 200 时 , 也 就 是 大 概 有 0. 005 X 200 — 1s 
GPIO31 是 置 1 的 ,另外 1s 是 置 0 的 。 这 样 便 实 现 了 一 个 LED 灯 一 亮 一 灭 的 效果 。 

要 想 实 现 流水 灯 的 实验 ,可 搭建 如 图 5. 10 所 示 的 模型 。 在 下 载 模型 之 前 也 可 以 通过 仿 
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® Configuration Parameters: GPIO LED/Configuration (Active) 
[Q Search 
Solver Target selection 
Data Import/Export ccm 
Math and Data Types System target file: ert tic. — 
» Diagnostics Language: 
Vicar implerentelion. Description; Embedded Coder 
Model Referencing 
Simulation Target Build process 
» Coverage 网 Generate code oniy 
> HDL Code Generation C] Package code and artifacts Zip fle name: «emplys — — 
Tooichain settings 


图 5.6 自动 代码 生成 配置 


(& Configuration Parameters: GPIO LED/Configuration (Active) 
Gaee S NS pE t 
| Soler acm | |[V] Create code generation report 
| v Diagnostics | [IZ] Generate model Web view 
| Hardware Implementation | Metrics 
| Model Referencing | 
| Simulation Target | LJ] Static code metrics 
| Y Code Generation ; 
|... Optimization [e 
u 

Symbols 


图 5.7 自动 代码 生成 报告 


真 查看 是 不 是 预计 的 控制 效果 ,如 图 5. 11 所 示 ,加 入 Scope 模块 , 单 击 “ 运 行 ” 按 钮 名 或 者 按 
Ctrl 十 R 键 ,观察 仿真 结果 如 图 5. 12 所 示 。 由 仿真 结果 可 以 看 出 ,此 控制 模型 为 我 们 所 要 
的 结构 ,然后 单 击 “ 编 译 ” 按 钮 丹 5 或 者 按 Ctrl + B 键 将 此 模型 编译 下 载 到 主 控 板 ,观察 实验 
现象 ,验证 控制 算法 在 实际 硬件 上 运行 时 是 否 跟 仿真 结果 一 致 。 


[i Block Parameters: GPIO31 Bluet x| 


C2806x GPIO Digital Output (mask) (Link) 
Configures ge outputs for the holed pins. 


T veil Woe a valo. ge Trus atthe input of he blu. — | 
"nd pin high. A V of False will ground | 


图 5.8 GPIO 模块 配置 图 5.9 LED 流 水 灯 模 型 
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图 5.10 LED 流水 灯 模 型 图 5.11 LED 流水 灯 模 型 


图 5.12 控制 波形 图 


5.1.2 GPIO_INPUT 扫描 _NORMAL 模式 

在 配置 GPIO 输入 模式 的 时 候 , 使 用 按键 的 端口 输入 值 ,作为 GPIO 输出 模块 的 控制 m 
量 。 使 用 按键 (对 应 GPIO42) 控 制 其 中 一 个 LED 灯 ( 对 应 GPIO25) 的 亮 灭 , 另 一 个 LED 灯 视频 讲解 
(GPIO031) 用 于 验证 模型 是 否 下 载 到 硬件 中 ,按键 硬件 原理 图 如 图 5. 13 所 示 。 


S4 66 
GPIO40 GPIO39 
| KEY GPIO40/EPWM7A/SCITXDB 
be: GPIO41/EPWM7B/SCIRXDB 
SW-DPST KEY GPIO42/EPWMSA/TZI/COMPI OUT 


GPIO43 GPIO43/EPWMSB/TZ2/COMP2OUT 


GPIO44/MFSRA/SCIRXDB/EPWM7B 
图 5.13 按键 硬件 原理 图 


配置 GPIO 的 PUD( 上 拉 禁 止 寄 存 器 ) 使 能 GPIO42 的 电 平 上 拉 , 当 按键 按 下 时 ， 
GPIO42 检测 到 低 电 平 ( 置 0) , 当 没 按 下 时 GPIO42 为 高 电 平 ( 置 1) 。 因 此 需要 在 模型 中 先 
将 GPIO42 使 能 上 拉 , 如 图 5.14 所 示 。 I 

注意 ; 通过 执行 EALLOW 指令 允许 CPU 自由 写 入 受 保 护 的 寄存 器 。 在 修改 寄存 器 
之 后 ,可 以 通过 执行 EDIS 指令 清除 EALLOW 位 使 它们 再 次 受到 保护 ,EALLOW 和 EDIS 
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KEY_Control 


初始 化 ， 将 GPIO42 上 拉 使 能 
图 5.14 初始 化 配置 GPIO42 
一 般 是 成 对 出 现 的 。 


GPIO DI 选择 GPIO25.GPIO31 需要 选择 Toggle. Toggle 表示 电 平 翻转 。 搭 建 的 按键 
控制 模型 如 图 5. 15 所 示 ,仿真 步 长 为 0. 5s。 


KEY Control 


初始 化 ， 将 GPIO42 上 拉 使 能 


GPIO42_Key 


按键 控制 LED， 未 按 于 时 LED 亮 ， 按 下 时 LED 灭 


= 一 一 一 古国 


LED 闪 烁 ， 每 隔 0.5s 闪 烁 一 次 
图 5.15 按键 实验 模型 


在 上 述 配 置 完 成 ,并 完成 模型 的 搭建 后 ,将 模型 编译 下 载 到 主 控 板 。 先 观察 红色 的 
LED 灯 有 没有 闪烁 ,再 通过 控制 按键 按 下 与 否 来 控制 蓝 色 LED 灯 的 状态 。 


5.1.3 GPIO INPUT 扫描 _EXTERNAL 模式 


需要 注意 的 是 ,Simulink 的 External 模式 默认 使 用 的 是 SCIA , 波 特 率 为 115200b/s, 并 
且 默 认 复 用 I/O 口 是 GPIO28、GPIO29, 对 应 开发 板 上 的 SCIA 接口 是 RXA、TXA, 如 图 5.16 
所 示 。 所 以 在 进行 External 模式 操作 的 时 候 , 通 过 一 根 USB 转 TTL 通信 线 , 将 USB 的 
RX、TX 分 别 接 在 F28069 主 控 板 的 TXA、RXA 引 脚 。 注 意 ,USB 和 F28069 的 控制 板 要 共 
地 ,同时 不 能 将 线 序 接 反 ,否则 Simulink 无 法 通过 SCI 转 USB 5 DSP 进行 通信 。 使 用 
External 模式 可 极 大 地 方便 对 数据 的 观测 。 

首先 需要 在 模型 配置 时 对 外 部 模式 进行 设置 ,如 图 5. 17 所 示 。 将 Communication 
interface 设置 为 串 行 通 信 ,然后 在 “设备 管理 器 ”中 找到 串 行 通信 的 COM 口 ,输入 到 Serial 
port 中 ,如 图 5. 18 所 示 。GPIO 外 部 模式 模型 如 图 5. 19 所 示 。 

注意 : GPIO DI 模块 输出 数据 类 型 选择 uint8, 如 图 5. 20 所 示 。 
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Solver v Target hardware resources 
Data Import/Export 
Math and Data Types Groups 
> Diagnostics Build Tm El Enable loopback 
Clocking f 
" Suspension mode: |Free run 
Model Referencing ADC Wr < 
Simulation Target COMP Number of stop bits: |1 
> Code Generation . CAN A Parity mode: None —— wa i 
| |^ Coverage pcd Character length bits: 8 xx d 
HDL Code G ti ePWM 
š icd > Desired baud rate in bits/sec: [115200 
SCI A Baud rate prescaler (BRR = (SCIHBAUD << 8) | SCILBAUD)): 97 
Sci B Closest achievable baud rate (LSPCLK/(BRR-1)/8) in bits/sec: 114786 
SPLA Communication mode: Raw data m | 
SPI B — = . 
eQEP C] Blocking mode 
Watchdog Data byte order: |Litlle Endian I 加 
| SPIO0 7 Pin assignment(Tx).| GPIO29 BH P Ç [zJ] 
GPIOB 15 : : a = 
lad Pin assignment(Rx).| GPIO28 Í 
| GPIO16 23 rmn Lv. 


图 5.16 SCI 配 置 


Eie Edit View Display Diagram Simulation Analysis Code Tools Help 


m-c-8oo240-HBH-Q9 Vii 
图 5.17 配置 外 部 模式 


PEE 5 Ü Bluetooth 无 弱电 收发 器 

> Q aetas b Gë IDE ATA/ATAPI 控制 器 

> d asmia Z- rl 

NTE: T b Es WERDE 

> 8 本 地 用 户 和 组 E13 

ó i t Te ud. an: t DMA_ch6 Communication interface: |serial f 
s sü how - WF Bluetooth && FáGtalisRfr (COM) = Serial port: [COM3 

[E I - Xf USB- “SERIAL CH340 (COM [External mode ] w 

» Bs RESTORE E . UR | Verbose 


图 5.18 串口 配置 


按键 控制 
‘C2806x GPIO Digital Input. 


Configures GPIO inputs eu. the ol pins with 
qualification type settir 


初始 化 ， 将 GPIO42 上 拉 使 能 


按键 控制 LED， 未 按 下 时 LED 亮 ， 按 下 时 LED 灭 


LED 闪 烁 ， 每 隔 0.5s 进 行内 烁 一 次 
图 5.19 GPIO 外 部 模式 模型 图 5.20 GPIO DI 模块 数据 类 型 配置 
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在 上 述 配 置 完 成 后 ,再 次 单 击 Simulink 界面 的 “运行 ”按钮 将 代码 下 载 到 开发 板 上 ,可 
以 看 到 ,Simulink 处 于 仿真 运行 状态 , 按 下 主 控 板 按键 ,可 以 在 Display 模块 中 看 到 数值 的 

由 于 GPIO4 默认 上 拉 使 能 ,所 以 在 按键 未 按 下 前 Dispaly 显示 1, 按 下 后 显示 0, 如 
图 5. 21 所 示 。 同 时 观察 蓝 色 LED 灯 的 亮 灭 情况 可 以 判断 Display 显示 是 否 正确 ,如 图 5. 22 
所 示 。 


按键 控制 


LED 闪 烁 ， 每 隔 0.5s 进 行头 烁 一 次 
图 5.21 按键 按 下 实验 现象 


按键 控制 


初始 化 ， 将 GPIO42 上 拉 使 能 


GPIO42 Key 


按键 控制 LED， 未 按 下 时 LED 亮 ， 按 下 时 LED 灭 


GPIO3! Biue. 


LED 闪 烁 ， 每 隔 0.5s 进 行内 烁 一 次 
图 5.22” 按键 松 开 实验 现象 


5.1.4 GPIO INPUT 中 断 控制 LED XT 


GPIO 不 仅 可 以 实现 通用 1/0 数字 量 输出 的 功能 ,还 可 以 配置 成 外 部 中 断 实现 控制 目 
的 。 比 如 将 最 常用 的 按键 配置 成 外 部 中 断 ,在 中 断 中 执行 参数 或 模式 的 修改 ,这 样 比 常用 的 
按键 扫描 方式 要 节省 资源 。 

在 Simulink 中 搭建 模型 ,配置 GPIO42 为 外 部 中 断 触发 源 ,并 将 中 断 配置 为 下 降 沿 触 
发 ,对 应 外 部 中 断 3。 在 中 断 函 数 中 分 别 进行 对 应 的 LED 的 翻转 ,GPIO42 对 应 LEDI 4T 
(GPIO31) ,LED2 ATCGPIO25) ,. 仿真 模 型 如 图 5. 23 所 示 ,系统 仿真 步 长 为 0.05s。 
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通过 按键 控制 LED 的 一 亮 一 灭 


Interrup 
C28x Hardware Interrupt 


cmm Md 


图 5.23 中 断 仿 真 模型 


其 中 System Initialize 中 写 入 的 是 GPIO42 的 初始 化 代码 ,如 图 5. 24 所 示 。 


Te Function Ed! Code 


Ferari GPAPUD.bit.GPIO42 = 0; /HE 1e E32 
GpiolntRegs.GPIOXINT3SEL.bit.GPIOSEL 242; reet TEAPA XONTS A 318 
XintruptRegs. XINT3CR.bit POLARITY = 0; I/F Ri Re 2: 
Dee 21 dabas 


图 5.24 GPIO 初始 化 配置 


硬件 中 断 模块 配置 如 图 5. 25 所 示 ,中 断 号 为 CPU-12,PIE-1 也 就 是 外 部 中 断 XTIN3， 
任务 优先 级 默认 ,Preemption flags 输入 1 表示 中 断 可 以 被 抢占 。 输 入 0 表示 中 断 不 能 被 抢 
占 。 更 多 的 详细 信息 请 单 击 该 模块 的 Help 按钮 了 解 。 


Block Parameters: ECAP3 INT Hardware Interrupt 


C28x Interrupt Block (mask) (link) 


Create Interrupt Service Routine which will execut 
downstroam subsystem. 


Noto: The default model base sample rate priority 
40 with a lower priority value indicating a higher 
task. These parameters can be changed in the 'Solv 
of the 'Configuration Parameters’. The Simulink ta 
priority of the selected interrupt is relative to 
base Tere pls: ty settings. 


C28x Parameters i 
CPU interrupt numbers: 
[i2 


IRQI2 


Interrupt PIE interrupt numbers: 


C28x Hardware Interrupt h 
Simulink task priorities: 


[30 


Preemption flags: poegtanti b Te 
B sez: 


[C] Enable simulation input 


图 5.25 中 断 配置 


Trigger 子 系统 里 面 为 LED 灯 的 控制 模型 ,如 图 5.26 所 示 , 且 在 控制 模型 的 GPIO Do 
模块 中 不 选中 Toggle。 
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GPI031 GPIO25 


站 


图 5.26 GPIO 中 断 触 发 模型 


在 上 述 配置 完成 ,并 完成 模型 的 搭建 后 ,将 生成 的 工程 代码 下 载 到 主 控 板 上 。 按 下 一 次 
按键 ,可 以 发 现 对 应 的 LED 灯 电 平 便 翻转 一 次 。 


5.2 ADC 


5.2.1 ADC 基本 原理 


1. ADC 转换 步骤 

A/D 转换 器 (ADC) 将 模拟 量 转换 为 数字 量 通常 要 经 过 4 个 步 又, 采样 保持 .量化 和 
编码 。 

所 谓 采样 ,就 是 将 一 个 时 间 上 连续 变化 的 模拟 量 转 “O ra 
化 为 时 间 上 离散 变化 的 模拟 量 ,如 图 5. 27 所 示 。 

将 采样 结果 存储 起 来 ,直到 下 次 采样 ,这 个 过 程 称 o ^ , 
作 保持 。 一 般 地 ,采样 器 和 保持 电路 一 起 总 称 为 采样 保 "Tm 


持 电路 。 

将 采样 电 平 归 化 为 与 之 接近 的 离散 数字 电 平 ,这 个 过 程 称 作 量化 。 

将 量化 后 的 结果 按照 一 定数 制 形 式 表示 就 是 编码 。 

将 采样 电 平 ( 模 拟 值 ) 转 换 为 数字 值 时 ,主要 有 两 类 方法 : 直接 比较 型 与 间接 比较 型 。 

CD 直接 比较 型 : 就 是 将 输入 模拟 信号 直接 与 标准 的 参考 电压 比较 ,从 而 得 到 数字 量 。 
这 种 类 型 常见 的 有 并 行 ADC 和 逐次 比较 型 ADC. 

(2) 间接 比较 型 : 输入 模拟 量 不 是 直接 与 参考 电压 比较 ,而 是 将 二 者 变 为 中 间 的 某 种 
物理 量 再 进行 比较 ,然后 将 比较 所 得 的 结果 进行 数字 编码 。 这 种 类 型 常见 的 有 双 积 分 型 
的 ADC. 

2. ADC 转换 原理 

EH iB A/D 转换 器 由 比较 器 ,D/A 转换 器 N 位 寄存 器 及 控制 逻辑 电路 组 
成 ,如 图 5.28 所 示 。 

基本 原理 是 从 高 位 到 低位 逐 位 试探 比较 ,好 像 用 天 平 称 物体 ,从 重 到 轻 逐 级 增 减 夸 码 进 
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NN 位 D/A 转换 器 


N 位 寄存 器 


图 5.28 ZKK A/D 转换 器 原理 图 


行 试探 。 逐 次 通 近 法 的 转换 过 程 是 : 初始 化 时 将 逐次 通 近 寄存 器 各 位 清 零 ,转换 开始 时 , 先 
将 逐次 逼近 寄存 器 最 高 位 置 1, 送 入 D/A 转换 器 ,经 D/A 转换 后 生成 的 模拟 量 送 入 比较 
器 , 称 为 Uu ,与 送 入 比较 器 的 待 转换 的 模拟 量 Ux ETT IUE A U, <U, , 则 该 位 1 被 保留 ， 
否则 被 清除 。 然 后 再 置 逐 次 台 近 寄存 器 次 高 位 为 1, 将 寄存 器 中 新 的 数字 量 送 D/A 转换 
器 ,输出 的 U, 再 与 Ux 比较 ,车 Uo 过 Ux uid 1 被 保留 ,否则 被 清除 。 重复 此 过 程 ,直至 
通 近 寄存 器 最 低位 。 转 换 结束 后 ,将 逐次 允 近 寄存 器 中 的 数字 量 送 入 缓冲 寄存 器 ,得 到 数字 
量 的 输出 。 逐 次 逼近 的 操作 过 程 是 在 一 个 控制 电路 的 控制 下 进行 的 。 

采用 双 积 分 法 的 A/D 转换 器 由 电子 开关 、 积 分 器 、 比 较 器 和 控制 逻辑 等 部 件 组 成 ,如 
图 5. 29 所 示 。 


EF 


数字 量 ”时 名 
图 5.29” 双 积分 法 的 A/D 转换 器 


基本 原理 是 将 输入 电压 变换 成 与 其 平均 值 成 正比 的 时 间 间 隔 , 再 把 此 时 间 间 隔 转换 成 
数字 量 , 属 于 间接 转换 。 双 积分 法 A/D 转换 的 过 程 是 : 先 将 开关 接 通 待 转换 的 模拟 量 Vi， 
V, 采样 输入 到 积分 器 ,积分 器 从 零 开始 进行 固定 时 间 T 的 正 向 积分 ,时 间 T 到 后 ,开关 再 
接 通 与 Vi; 极 性 相反 的 基准 电压 Ver ,将 Var 输入 到 积分 器 ,进行 反 向 积分 ,直到 输出 为 
OV 时 停止 积分 。V'; 越 大 ,积分 器 输出 电压 越 大 , 反 向 积分 时 间 也 越 长 。 计 数 器 在 反 向 积分 
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时 间 内 所 计 的 数值 ,就 是 输入 模拟 电压 V; 所 对 应 的 数字 量 ,实现 了 A/D 转换 。 

3. ADC 关键 技术 指标 

(1) 分 辨 率 (Resolution) 指 数字 量变 化 一 个 最 小 量 时 模拟 信号 的 变化 量 ,定义 为 满 刻 度 
与 2" 的 比值 。 分 辨 率 又 称 精度 ,通常 以 数字 信号 的 位 数 来 表示 。 

(2) 转换 速率 (Conversion Rate): 也 可 以 称 为 A/D 采样 率 ,是 A/D 转换 一 次 所 需要 时 
间 的 倒数 。 单 位 时 间 内 ,完成 从 模拟 转换 到 数字 的 次 数 。 积 分 型 A/D 的 转换 时 间 是 毫秒 
级 , 属 低速 A/D; 逐次 比较 型 A/D 是 微 秒 级 , 属 中 速 A/D, 全 并 行 / 串 并 行 型 A/D 可 达到 纳 
秒 级 。 采 样 时 间 则 是 男 外 一 个 概念 ,是 指 两 次 转换 的 间隔 。 为 了 保证 转换 的 正确 完成 ,采样 
速率 (Sample Rate) 必 须 小 于 或 等 于 转换 速率 。 因 此 有 :人 习惯 上 将 转换 速率 在 数值 上 等 同 
于 采样 速率 也 是 可 以 接受 的 。 常 用 单位 是 ksps 和 Msps, 表 示 每 秒 采 样 千 / 百 万 次 (kilo/ 
Million Samples per Second) , 

(3) 量化 误差 (Quantizing Error): 由 于 A/D 的 有 限 分 辩 率 而 引起 的 误差 , 即 有 限 分 辩 
X A/D 的 阶梯 状 转移 特性 曲线 与 无 限 分 辩 率 A/D( 理 想 A/D) 的 转移 特性 曲线 (直线 ) 之 间 
的 最 大 偏差 。 通 常 是 1 个 或 半 个 最 小 数字 量 的 模拟 变化 量 ,表示 为 1LSB.1/2LSB, 

(4) 偏 移 误 差 (Offset Error): 输入 信号 为 零 时 输出 信号 不 为 零 的 值 , 可 外 接 电位 器 调 


至 最 小 。 

(5) 满 刻 度 误差 (Full Scale Error): 满 度 输出 时 对 应 的 输入 信号 与 理想 输入 信号 值 
Z=, 

(6) 线性 度 (Linearity) : 实际 转换 器 的 转移 函数 与 理想 直线 的 最 大 偏 移 , 不 包括 以 上 
3 种 误差 。 


其 他 指标 还 有 绝对 精度 (Absolute Accuracy)、 相对 精度 (Relative Accuracy) 、 微 分 非 线 
性 .单调 性 和 无 错 码 ,总 谐 波 失真 (Total Harmonic Distotortion ,THD) 和 积分 非 线性 。 

TMS320F2806x 的 ADC 模块 主要 包括 以 下 内 容 。 

。 12 位 模 数 转换 。 

。 2 个 采样 保持 器 (S/H)。 

。 同步 采样 或 顺序 采样 。 

。 模拟 电压 输入 范围 0 一 3. 3V。 

。 16 通道 模拟 输入 。 

。 16 个 结果 寄存 器 存放 ADC 转换 的 结果 。 

。 多 个 触发 源 : S/W 一 一 软件 立即 启动 .ePWMI1~ePWM8, 外 部 中 断 2 脚 ,定时 器 0、 

1,2 以 及 A/D 中 断 1、2。 

关于 ADC 单元 寄存 器 的 具体 描述 在 这 里 不 再 进行 具体 介绍 ， 感 兴趣 的 读者 可 以 参考 
TMS320F28069( 以 下 简写 为 F28069) 的 数据 手册 ,里 面 有 详细 讲述 ,F28069 主 控 板 关于 
A/D 引 脚 原理 图 如 图 5. 30 所 示 。 
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5V p2 
I 
IICOEPTIA 2 GPIO52 z 
3 3 
QEPIB : i 
DCSCL 
ek 5 5 23 ADCINA 
GPIO40 s : 
GPIO3 1 ; ADCINA2/COMPIA/AIO2 
GPIO2 : 4 ADCINA3 
EP2A E ADCINA4/COMP2A/AIO4 
EP2B i UARTA TX ADCINAS 
ÜARTB TX u ADCINA6/COMP3A/AIO6 
UARTBRX — | Ë ADCINA7 
| B 3 ADCINBO 
I = ll à ADCINBI 
| INB2/COMPIB/AIO10 


图 5.30 A/D 引 脚 原理 图 


5.2.2 ADC NORMAL 模式 


ADC NORMAL 模式 配置 先 从 配置 时 钟 开始 , ADC 模块 是 挂 在 高 速 外 设 时 钟 线 上 的 
外 设 ,Clocking 配置 为 系统 90MHz 时 钟 2 分 频 。 在 ADC 配置 中 ,使 用 默认 的 分 频 系 数 
ADCLK= 三 2, 得 到 ADC 模块 时 钟 为 45MHz, 其 他 使 用 默认 配置 。 具 体 配 置 如 图 5. 31 所 示 。 


@ Configuration Parameters: ADC LED/Configuration (Active) 


Q Search 
Solver | Hardware board settings 
Data Import/Export 
Math and Data Types | > Operating system/scheduler settings 
s SEEN plementation |o Target hardware resources 
Model Referencing | m 
Simulation Target | IM 
> Code Generation | BO ODE ADC clock prescaler (ADCCLK); [SYSCLKOUT/2 
* Coverage | LIA — ADC clock frequency in MHz: 45 ` 
l H n 一 -一 一 ~ — 
7 VDL GOOG CSERE | wm ADC overlap of sample and conversion (ADCNONOVERLAP): 
eCAN_A Offset: |AdcRegs. ADCOFFTRIM.biLOFFTRIM 


图 5.31 ADC 模块 配置 


采样 模式 为 单个 采样 模式 ,SOC 和 触发 数 为 SOC0 ,采样 窗口 为 7,SOCx 触发 源 为 软件 触 
发 ,输出 数据 类 型 为 uint16, 输 入 通道 配置 为 A0, 此 模块 数据 基本 为 默认 。 具 体 配置 如 
图 5. 32 和 图 5.33 所 示 。 

在 以 上 配置 完成 后 ,对 ADC 采样 的 值 进行 转换 。 由 于 ADC 转换 结果 寄存 器 是 16 位 
的 , 且 数 值 是 左 对 齐 的 12 位 数据 ,所 以 要 进行 左 移 4 位 的 操作 。 官 方 支持 包 人 性 化 地 做 了 
这 一 点 ,只 需 直 接 对 输出 的 结果 进行 转换 就 可 以 得 到 实际 的 采样 值 。 本 例 中 采集 的 是 外 部 
电位 器 的 0 一 3. 3V, 的 电压 ,所 以 直接 进行 转换 (因为 是 12 位 的 ADC, 故 满 量 程 为 4096 ,也 
就 是 4096 对 应 实际 的 参考 电压 3. 3V)。 当 采集 到 的 模拟 量 少 于 .2048 时 ,使 LED2 灯 闪 烁 ， 
否则 使 LEDI 灯 闪 烁 。 模 型 搭建 如 图 5.34 所 示 。 模 型 中 的 Rate Transition 为 高 采样 速率 
向 低 采 样 速率 转换 。 
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Ba] Siock Parametere Arc 


X/004x ADC (mask) (link) 
aures the AOC to output data collected from the AUC 
pins ou the Ld 


SOC: Start of Conversi 
EOC: End of Conversion 


SOC Trigger _ Input Channels | 
Sampling mode S 


E PT a UT 
i EE | 


| 
: | 


C2802x/03x/05x/06x 
A0 


SOC acquisition window 


ADC 


Sample time: 


Data type: 5 
C Post interrupt. at EOC trigger 


CE — S BN 
图 5. 32 ADC 模块 配置 


C2802x/03x/05x/06x 
A0 
ADC 


— 


图 5.33 ADC 模块 输入 通道 配置 


当 采 集 电压 小 于 1.65V 时 点 亮 红 色 LED， 使 其 不 断 闪烁 
当 采 集 电压 大 于 1.65V 时 点 亮 蓝 色 LED， 使 其 不 断 闪烁 


图 5.34 电压 采集 模型 图 


在 上 述 配置 完成 ,并 完成 模型 的 搭建 后 ,将 模型 编译 下 载 到 主 控 板 。 将 电位 器 的 中 间 引 
脚 接 在 主 控 板 的 ADO 引 脚 ,其 他 两 个 引 脚 分别 接 在 主 控 板 的 3.3V 和 GND 引 脚 。 可 以 发 
现 , 在 顺 时 针 和 逆 时 针 调 节 电 位 器 时 ,两 个 LED 灯 都 发 生 了 变化 。 


第 5 章 ”基础 应 用 |P 69 


5.2.3 ADC EXTERNAL 模式 


先 将 模型 按照 前 述 方 法 配置 为 外 部 模式 

在 Simulink 中 搭建 模型 ,如 图 5. 35 所 示 , 将 ADC 输出 值 通过 一 个 增益 模块 赋 给 PWM 
的 占 空 比 输入 ,并 在 显示 模块 上 显示 。 其 中 ,Gain 模块 的 输出 数据 为 uint16,ePWM 模块 选 
择 ePWM1, 这 里 WA 相当 于 占 空 比 的 大 小 ,相关 配置 在 5.3 节 有 详细 介绍 . 


Rate Transiöon 


图 5.35 ”外 部 模式 配置 

在 上 述 配置 完成 ,并 完成 模型 的 搭建 后 ,用 USB 转 TTL 线 , 分 别 将 USB 的 RX、TX 接 
在 F28069 主 控 板 的 TXA、RXA 引 脚 上 。 启 动 仿真 ,通过 调节 电位 器 便 能 观察 到 Scope 模 
块 的 数据 变化 ,如 图 5. 36 所 示 。 


Running Sampie based |Offsete160 T=168 000 


图 5.36 Scope 模块 显示 


5.3 Timer IT 


视频 讲解 


在 多 数 情况 下 Timer0 都 作为 系统 默认 的 时 基 , 如 图 5. 37 所 示 的 Base rate trigger fE 
为 Simulink 模型 的 触发 率 。 那 么 触发 步 长 在 Slover 中 为 Fixed-step size (fundamental 
sample time) ,如 图 5. 38 所 示 ,配置 Simulink 模型 的 执行 周期 为 1s, 也 就 是 1Hz 的 执行 


频 率 


70 «|| 智能 平衡 移动 机 器 人 (MATLAB/Simulink 版 * 微 课 视 频 版 ) 


|; Solver Hardware board: TI Piccolo F2806x 
| ; Data Import/Export 
Math and Data Types Code Generation system target fle: ert.tic 
| : Diagnostics Device vendor: Texas Instrumenis. 
OB ea] > Device etai 
Model Referencing 
|| Simulation Target Hardware board settings 
| + Code Generation 
» Coverage v Operating system/scheduler settings 
» HDL Code Generation 


| Scheduler options 
I 


Baseraesgger[Tmero | 
Fd 5.37 定时 器 中 断 配 置 图 


f Configuration Parameters: PWM Output/Configuration (Active) 


[Q Search — 

SERET sunusuonume 

| Data import/Export l | t. r 

| Math and Data Types j Starttime: 00 — — — à 1 1 à jStptme lint 


j Solver: discrete (no continuous states) X 


图 5.38 步 长 设置 图 


在 上 述 配 置 完成 ,并 完成 模型 的 搭建 后 ,如 图 5.39 Bros ,将 模型 编译 下 载 到 主 控 板 上 。 
最 终 可 以 观察 到 ,LED1 灯 每 秒 闪 烁 一 次 。 


c _ 


GPIO31 Blue 


图 5.39 模型 搭建 图 


可 以 把 此 模型 生成 的 工程 文件 在 CCS 编译 器 中 打开 ,复制 MTLAB 的 工作 路 径 D: N 


MBD28069_BalanceCar\Chapter2\2. 3Timer_ IT, 导入 到 CCS 中 ,可 以 看 到 如 图 5. 40 所 示 
的 一 些 文件 。 


HTE Gert mainc = à Timer IT.c 


~ 3$ Timer IT [Active - Debug] | i6finclude "Timer IT.h" 


» 8) Includes | 17#include "rtwtypes.h" 
» ® Debug j 18 
i9volatile int IsrOverrun = 0; 
M rr |.20&tatic boolean T Qverr| qe 
bara tension a 1lvoid rt, OneStep(void) 
erTimerO.c 
1 (23 /* Check for overrun. Protect OverrunFlag against preemption */ 


7 M24 if (OverrunFlage*) ( 
> &F2806x CodeStartBranch.asm | 
> à F2806x CpuTimers.c 
| > i&F2806x Defaultisr.c 
| > &F2806x Dmac 
> [Ñ F2806x GlobalVariabieDefs.c 
> IÀ F2806x PieCtri.c 
> @F2806x PieVect.c 
> @F2806x_SysCtrlc 
| ÍRF2806x usDelay.asm 


IsrOverrun s 1; 
OverrunFlag--; 
return; 


1 38volatile boolean T stopRequested; 
39volatile boolean, T runModel; 
48tnt main(void) 

at 
42 float modelBaseRate = 1.0; 

43 float systemClock = 90; 
44 


图 5.40 CCS 程序 图 
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(1) ert. main. c; 主要 是 对 控制 芯片 一 些 初始 化 操作 、while 循环 和 中 断 函 数 的 调用 。 

(2) Timer IT. c; 主要 包括 初始 化 函数 、 定 时 器 0 中 断 操作 函数 、 主 函数 里 面 的 初始 化 函数 。 

(3) 图 5. 40 中 的 3 和 4 为 定时 器 0 中 断 执行 函数 ,Timer_IT_step() 函 数 为 rt_One_ 
Step() 函 数 的 子 函数 ,在 Simulink 中 搭建 的 控制 模型 基本 在 定时 器 0 中 断 函 数 执行 ,除了 
C28x Hardware Interrupt,Idle Task 等 一 些 特 别 声明 的 模块 。 

(4) 如 图 5. 41 所 示 ,是 main 主 函 数 的 一 些 命令 。 


int main(void) ` 


float modelBaseRate = 1.9; 
float systemClock = 90; 

/* Initialize variables kd 
s 

runModel = false; 

c2000 flash init(); 

init . board( mn 


rrorStatus(Timer IT M, 0); 
Q0; 


globa sable(); 
Ek ere ee AR; systemClock); 
runModel = 
rtmGetErrorStatus(Timer IT M) == (NULL); 
Q; 


stopRequested = |( 
rtmGetErrorStatus(Timer IT M) == (NULL)); 


图 5.41 CCS 程序 图 一 


(5) modelBaseRate 也 就 是 之 前 设 定 的 定 步 长 大 小 ,systemClock 就 是 系统 时 钟 大 小 ， 
Flash 烧 写 初始 化 。 

(6) init_board() 主 要 是 对 Simulink 模型 配置 参数 中 的 1/0 口 进行 初始 化 ,Timer_IT_ 
initialize() 主 要 是 对 Simulink 中 搭建 的 一 些 GPIO 进行 初始 化 ,如 图 5. 42 所 示 , 其 中 的 
0xFCFFFFFF 是 对 GPIO31 的 配置 。 


/* Model step function */ 
void Timer IT step(void) 


/* S-Function (c280xgpio do): '«Root»/GPIO31 Bluel' incorporates: 
* Constant: '«Root»/Constant* 
*/ 


t 
if (Timer IT P.Constant Value) 
GpioDataRegs.GPASET.bit.GPIO25 = 1; 
else 
GpicDataRegs.GPACLEAR.bit.GPIO25 < 1; 
) 
H 
/* Model initialize function */ 
void Timer IT initialize(void) 
t 


/* Registration code */ 


/* initialize error status 

rtmSetErrorStatus (Timer. VM (NULL)); 

/* Start for S-Function (cipio. do): '«Root»/GPIO31 Bluel' incorporates: 
* Constant: '«Root»/Con: 

SAN 


epieCtr tags. APUD GPAMUX2.a1l &= @xFFFFFFCF; 
ecce: GPADIR.all |» ex4e000; 


图 5.42 CCS 程序 图 二 
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(7) configureTimer0() 是 计算 定时 器 0 产生 中 断 的 时 间 间 隔 。 
(8) void ConfigCpuTimer (struct CPUTIMER _ VARS * Timer, float Freq, float 
Period) ,CPUTIMER VARS x Timer 表示 选择 哪个 定时 器 ,Freq 表示 定时 器 频率 ,Period 


表示 定时 器 周期 值 。 


(9) ConfigCpuTimer( &.CpuTimer0 ,systemClock ,baseRatex 1000000) , 
(100 计算 公式 为 : T = systemClock * baseRate * 1000000/CpuTimerO, 如 图 5. 43 


所 示 。 


CpuTimeréRegs.TPR.all = 6; 
CpuTimereRegs.TPRH.all = e; 


“ 
// Make sure timer is stopped: 


CpuTimereRegs.TCR.bit.TSS = 1; 


t 

// Reload all counter registar with period value: 
“ 

CpuTimer@Regs.TCR.bit.TRB = 1; 


H 
// Reset interrupt counters: 
f 


CpuTimere.InterruptCount = 6; 
#endif 


/* Configure CPU-Timer 8 to interrupt every 0.8025 sec. */ 
ad imei H me Pini PI i" o. m Pt od in ec. 
ConfígCpuTimer(&CpuTimer8, systemClock, baseRate * 1000000); 
tartCpuTimeró(); 
x 1 
PieVectTable.TINT8 = &TINTO isr; /* Hook interrupt to the ISR* 


PieCtrlRegs.PIEIERI.bit.INTx7 = 1; P Enable interrupt TINTG */ 
IER |= M INT1; 


(11) 根据 之 前 的 设置 ,可 以 得 到 T—90 * 1 * 1000000/90000000 — 15, 
(12) enableTimer0Interrupt() 使 能 定时 器 0 中 断 ,globalInterruptEnable() 使 能 全 局 中 


Br, du Pj Du 44 所 示 。 


asm(" RPT #5 || NoP"); /* wait 5 cycles */ 
IFR &= «IFRMASK; /* eventually 
rd = IFRMASK; /* ACK to allı 
IER |= 1; 


NT /* global interrupt 
(renes: ] 
DINT; /* disable global ir 
Wifdef PIEMASKO 
PieCtrlRegs.PIEIER1.all = PIEIER1 stack save;/*restore 
ftendif a 


图 5.44 CCS 程序 图 四 
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(13) while 为 函数 的 循环 语句 ,其 中 Simulink 中 Idle Task 模块 就 是 运行 在 while 中 。 

首次 在 CCS 中 编译 Simulink ÆR BJ 4 83 RU , fa 98 #6 1T FF m f28069.cexml [Active] ,然后 选择 

应 的 仿真 器 型 号 ,第 一 次 打开 默认 是 XDS100v1, 由 于 主 控 板 使 用 的 是 v2, 所 以 选择 

XDS100v2 , 先 单 击 右 侧 的 Save 按钮 ,然后 再 选择 对 应 的 设备 TMS320F28069, 最 后 单 击 

Test Connection 按钮 ,如 图 5. 45 所 示 ,此 时 计算 机 会 跟 主 控 板 通信 ,最 终 出 现 如 图 5. 46 所 
示 的 界面 ,说 明 已 经 配置 成 功 。 


ee ARES eet tna 


This section describes the general configuration about the target. 


Target Configuration: lists the configuration options for the target. 


Board or Device |type filter text CQ AT 
T mee | 3 
口 TMS320F28064 l: 
C TM5S320F28065 Hn oe E T 
DD TMS320F28066 To test a connection, all changes must have been saved, the 
C) TMS320F28067 i configuration file contains no errors and the connection type supports this function. 
L 4 
2 m 
C TM$320F28074 ED MINAS 
D) 1M5320F28075 
口 1M5320F28076 |. | [Uart Communication ~ 
1! 28079 v 
[msan - To enable host side (Le. PC) configuration necessary to facilitate data 
Dual Motor Control and PFC Developer's Kit (F28035) f communication over UART, target application needs to include a monitor 


implementation. Please check example project in TI Resource Explorer. If your 、 
target application leverages TI-RTOS, then please check documentation on how to 
enable Uart Monitor module. 


图 5.45 CCS 生 成 代码 设置 


This test will be applied just once. 


Do a test using OxFFFFFFFF. 

Scan tests: 1, skipped: 0, failed: 
Do a test using Qx60000000. 

Scan tests: 2, skipped: 0, failed: 
Do a test using 6xFE63E8E2. 

Scan tests: 3, skipped: 0, failed: 
Do a test using 0x01FC1F1D. 

Scan tests: 4, skipped: 0, failed: 
Do a test cial 0x5533CCAA. 

Scan tests: 5, skipped: rd failed: 
Do a test using @xAACC3 

Scan tests: 6, skipped: Hi “failed: 
All of the values were scanned correctly. 


| [The JTAG DR Integrity scan-test has succeeded. 


[End: Texas Instruments XDS190v2 USB Debug Probe 8] 
Kd 5.46 CCS 生成 代码 配置 
当 配 置 好 ccxml 文件 后 ,下 次 编译 工程 时 就 不 需要 再 进行 操作 了 。 现 在 就 可 以 单 击 
ACER" d VEU TER RR A TOUR WE 5.47 所 示 。 


File Edit View Navigate Project Run Scripts Window Help 
inr uoeie Ce cim uim om 


图 5.47 程序 编译 
后 再 单 击 渴 a 形状 的 “调试 "按钮 ,程序 会 下 载 到 主 控 板 , 之 后 再 单 击 "运行 "按钮 鼎 |， 


就 可 观察 到 LEDI 灯 开 始 闪 烁 ,证 明 程序 已 经 运行 了 。 当 单 击 “暂停 ?按钮 珊 时 , 则 程序 会 
暂时 停止 在 芯片 上 运行 ,这 是 LED1 灯 停 止 内 烁 , 当 单 击 “终止 ?按钮 而 时 , 则 程序 停止 在 线 


® o o o © o 
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运行 ,如 图 5.48 所 示 。 关 于 CCS 更 多 的 操作 请 看 合 动 智能 科技 公司 的 (CCS6. 2 开发 人 门 


手册 》。 
File Edit View Project Tools Run Scripts Window Help 
| CT emilia brace co rino noi 
图 5.48 程序 运行 与 调试 
5.4 ePWM 


脉冲 宽度 调制 (PWM) 是 一 种 对 模拟 信号 电 平 进行 数字 编码 的 方法 ,其 根据 相应 载荷 的 
变化 来 调制 晶体 管 栅 极 或 基 极 的 偏 置 ,来 实现 开关 稳 压 电源 输出 晶体 管 或 晶体 管 导 通 时间 
的 改变 ,这 种 方式 能 使 电源 的 输出 电压 在 工作 条 件 变 化 时 保持 恒定 ,是 利用 微 处 理 器 的 数字 
输出 来 对 模拟 电路 进行 控制 的 一 种 非常 有 效 的 技术 ,广泛 应 用 在 从 测量 ,通信 到 功率 控制 与 
变换 的 许多 领域 中 。 

关于 PWM 的 控制 方法 ,采样 控制 理论 中 有 一 个 重要 结论 : 冲 量 相等 而 形状 不 同 的 窜 
脉冲 加 在 具有 惯性 的 环节 上 时 ,其 效果 基本 相同 ,如 图 5.49 Bron, 


KA NU! Kt) 
p 
Oo t o t O t 
(a) 矩形 脉冲 (b) 三 角形 脉冲 (c) 正弦 半 波 脉冲 ae 
图 5.49 采样 原理 


PWM 控制 技术 就 是 以 该 结论 为 理论 基础 ,对 半导体 开关 器 件 的 导 通 和 关 断 进行 控制 ， 
使 输出 端 得 到 一 系列 幅 值 相等 而 宽度 不 相等 的 脉冲 ,用 这 些 脉 冲 来 代替 正弦 波 或 其 他 所 需 
要 的 波形 。 按 一 定 的 规则 对 各 脉冲 的 宽度 进行 调制 , 既 可 改变 逆 变 电路 输出 电压 的 大 小 ,也 
可 改变 输出 频率 ,如 图 5. 50 所 示 。 


PWM 波 可 等 效 的 各 种 波形 
> 直流 斩 波 电路 ”4 加 直流 波形 
> SPWM 波 ”多 正弦 波形 
> 等 效 成 其 他 所 需 波形 ， 如 : 


XOFTERREETHEREE E 


Mn n 


0s ms 10ms lSms  20ms 25ms  30ms 
。 所 需 波形 — 。 等 效 的 PWM 波 


图 5.50 等 效 PWM iX 
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TMS320F28069 有 19 路 脉 宽 调制 输出 引 脚 (这 些 引 脚 需 要 软件 进行 配置 ,类 似 于 前 面 
的 普通 GPIO 的 配置 ) ,这 19 路 脉 宽 调制 输出 引 脚 包括 16 路 增强 型 PWM(ePWM) 和 3 路 
普通 PWM(ECap 模块 复 用 ) ,16 路 增强 型 PWM 中 又 有 8 路 可 以 配置 为 高 分 辩 率 的 PWM 
(HRPWM)。8 组 PWM 模块 ,每 一 组 又 有 2 路 PWM ,分 别 是 PWMA 和 PWMB。 

一 个 ePWM 模块 包括 Time-base (TB) module (Hf JE f$ 3t) , Counter-compare ( CC) 
module( 计 数 器 比较 模块 )、Action-qualifier(AQ) module HE £ Jy 3X ffi E BE dt ) , Dead-band 
(DB) module ( JE [X i H), PWM-chopper C PC) module ( 9r UE $ St) , Event-trigger (ET) 
module( 事 件 触发 模块 ) Trip-zone( TZ) module (FEKRR) JE 7 个 模块 。 关 于 各 个 模块 
的 介绍 请 参考 刘 杰 编写 的 《Simulink 建 模 基础 及 C2000 DSP 代码 自动 生成 》。 

本 次 应 用 案例 利用 的 是 EPWMI1 模块 ,其 原理 图 如 图 5. 51 所 示 。 

GPIO0/EPWMIA 
GPIOI/EPWMIB/COMPIOUT 
GPIO2/EPWM2A 

E RN CI UVEOMPIAUT 
GPIO4/EPWM 
ONOAEPUADBPRIMDAECAPI 


GPIO6/EPWM4A/EPWMSYNCI/EPWMSYNC( 
GPIO7/EPWMAB/SCIRXDA/ECAP2 


图 5.51 EPWMI1 模块 接口 
以 下 通过 3 个 例子 对 PWM 的 功能 进行 说 明 。 
5.4.1 ePWM 单 路 输出 


1。 方 法 一 

ePWM 模块 输入 时 钟 ,直接 由 系统 时 钟 而 来 ,使 用 的 时 候 可 以 根据 用 户 需 要 进行 分 频 
f£ ePWM 的 设置 界面 的 General 选项 卡 中 ,配置 为 ePWMI1 模式 ,对 PWM 模块 进 4 初始 化 
配置 ,时 钟 周 期 单元 选择 Clock cycles, 计 数 模 式 选 择 Up-Down 计数 ,如 图 5.52 所 示 。 


———- x 
co . Counter Compare — 


Timer pacta units: 


Specify timer period via: [Sp$e 


Timer period: 


Reload for time base period register (PRDLD): [Edi 
[Counting mode: URDEA MUN 


‘Synchronization action: Belo Wo pha 
Counting direction after phase synchronization: WO aa S 
Phase offset value (TBPHS): 
lo 


Specify software synchronization vía input port (SWFSYNC) 
Enable digital compare A event] synchronizat (DCAEVTD 
cim Enable digital compare B event] syne! 


Time base clock (TBCLK) prescaler divi 
High speed time base clock (HSPCLKDIV) pre: 
D] Enable swap module A and B 


图 5.52. ePWM 模块 配置 
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TBCLK=SYSCLKOUT/(HSPCLKDIV * CLKDIV) ,本 次 实验 系统 时 钟 SYSCLKOUT 
设置 为 80MHz, 取 HSPCLKDIV 选择 4 分 频 ,TBCLK 分 频 选择 2 分 频 ,所 以 ePWMI 的 时 
基 时 钟 为 TBCLK==80/(2* 4) 二 10MHz;, 设 置 周期 寄存 器 值 为 10000, 因 此 ePWM1 的 输出 
BE 10MHz/10000—1kHz. f 

在 ePWMA 选项 卡 配置 使 能 ePWMA, 当 计数 等 于 0 的 时 候 不 动作 ,等 于 比较 寄存 器 
CAU 的 值 的 时 候 复位 ,等 于 比较 寄存 器 CAD 的 值 的 时 候 置 高 ,其 他 时 间 不 动作 。 
ePWMB E [X Rf [8] .事件 触发 以 及 错误 联防 均 不 配置 ,如 图 5.53 所 示 。 


[eg] Block Parameters: ePWMT x 


回 Enable ermina 
Action when counterzZERO: 


| Action when counter=CMPU on down-count (CBD); p 
OD Add continuous software force input port 
Continuous software force logic: BR 
Reload condition for software force: HERBERT 
RR N , 
CE 
图 5.53 ePWMA 计数 模式 配置 


对 Counter Compare 的 配置 : 将 CMPA units 设置 为 Percentage( 百 分 比 ); 比较 寄存 
器 CMPA 设置 成 Specify via dialog 内 部 指定 为 50, 即 占 空 比 为 50% ,如 图 5.54 所 示 。 
通过 以 上 配置 ,可 以 得 到 模型 如 图 5. 55 所 示 。 


[raj Bio Parameters: ePWM1 x 


ePWM1 


图 5.54 kei . B 5.55 ePWMI 模块 


2. 方法 二 
在 General 选项 卡 中 ,配置 为 eaPWM1 模式 ,对 PWM 模块 进行 初始 化 配置 ,时 钟 周期 
单元 选择 Seconds, 计数 模式 选择 Up-Down 计数 ,关闭 同步 功能 ,分 频 系 数 TBCLK 和 


HSPCLKDIV 均 为 1( 不 对 系统 时 钟 分 频 ) ,如 图 5.56 所 示 。 


Ir 

| n nitial period: 
lif 0. 001 

I 

Reload for time base period register (PRDLD): (Counter equala Xo. zero... 
i Counting wode: W PESCE " ý 
|| Synchronization action: 
Wm Specify software synchronization via input port (SWFSYNC) 
| Ej] Enable digital compare A event! synchronization (DCAEVTI) 
||[E] Enable digital compare B event! synchronization (DCBEVTI) 


图 5.56 PWM 周期 配置 
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对 ePWMA 配置 同方 法 一 ,这 里 配置 CMPA units 设置 为 Percentage( 百 分 比 ); 比较 
寄存 器 CMPA 设置 成 Input port( 由 外 部 输入 ),CMPA 初始 值 设 为 0, 如 图 5.57 所 示 。 


通过 以 上 配置 ,可 以 得 到 模型 如 图 5. 58 所 示 。 


Block Parameters: ePWM2 x | 


Specify CMPB via: 
CMPB initial value: 


(m 


Reload for compare B Register (SHDWBMODE): [ER 


方法 二 


Lc | 
占 空 比 


ePWM 


图 5.57 AZERE 图 5.58 ePWM 模块 配置 


在 上 述 配置 完成 ,并 完成 模型 的 搭建 后 ,将 模型 编译 下 载 到 主 控 板 ,然后 在 CCS 中 打开 
模型 生成 的 工程 文件 , 先 单 击 “ 编 译 ? 按 钮 A > ,再 单 击 “ 调 试 ”按钮 em ,然后 将 图 5. 59 中 
的 两 个 变量 添加 到 Expressions 中 , SE ZIT fl ae. ,可 以 看 到 TBPRD,CMPA 的 值 ,如 
图 5. 59 所 示 。 可 以 将 主 控 板 的 PWM1A 引 脚 连接 到 示波器 的 信和 号 线 , 主 控 板 和 示波器 记 
得 要 共 地 , 便 能 观测 到 输出 的 PWM 的 频率 是 否 为 1kHz, 占 空 比 是 否 为 50%。 注意 ,要 单 


击 Expressions 的 实时 刷新 按钮 ,否则 数据 不 会 变化 。 
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unsigned int | 5000 | 


图 5.59 变量 观察 


5.4.2 ePWM 双 路 互补 输出 


对 General 选项 卡 和 ePWMA 选项 卡 的 配置 同 5. 4. 1 节 中 的 方法 一 ,因为 要 输出 两 路 
互补 的 PWM, 所 以 这 里 使 能 ePWMIB 配置 与 ePWMI1A 相反 ,如 图 5. 60 所 示 。 
eerat | ema] “ra. L-comnter Gamers. | Desdmd n | 


II Enable cPRMIB 

EE 
[S 
Action when counter=CMPA on up-count (CAU): —— —— — 
Action when counter-CMPA on down-count (CAD): [aaashing — — 
Action when counter*CMPB on up-count (CHO D Te] 
Action when counter*CMPB on down-count cei E Tess —]— 


图 5.60 ePWMB 计数 模式 配置 


对 Counter Compare 的 配置 ; 将 CMPA units 设置 为 Clock cycles( 时 钟 周期 ); 比较 寄存 器 
CMPA 设置 成 Input port 输入 端口 ,初始 值 设 为 0; 对 CMPB 的 操作 一 样 , 如 图 5.61 所 示 。 


DEN ———————— 


OPB initial value: 
° = = 8 
Reload for compre B Register HNENUE): (tommtenuemmla d ger... necem) 


K 5.61 ePWM 周期 配置 
搭建 的 模型 如 图 5. 62 所 示 。 f 
输出 频率 为 kHz， 占 空 比分 别 为 60%、40% 的 脉冲 信号 


Dur DO ePWM1 


图 5.62 两 路 占 空 比 不 同 的 PWM 
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在 上 述 配 置 完成 ,并 完成 模型 的 搭建 后 ,将 模型 编译 下 载 到 主 控 板 , 然 后 在 CCS 中 打开 
模型 生成 的 工程 文件 , 先 单 击 “ 编 译 ” 按 钮 咏 v ,再 单 击 “ 调 试 ” 按 钮 元 机 ,然后 将 图 5. 63 中 
的 3 个 变量 添加 到 Expressions 中 , 单 击 “ 运 行 ” 按 钮 吕 ,可 以 看 到 TBPRD.CMPA.CMPB 
的 值 ,如 图 5.63 所 示 。 可 以 将 主 控 板 的 PWM1A 引 脚 和 PWMIB 引 脚 分 别 连接 到 示波器 
的 信号 线 , 主 控 板 和 示波器 记得 要 共 地 , 便 能 观测 到 两 路 PWM 的 频率 是 否 都 为 1kHz, 占 空 


比 是 否 分 别 为 60% 和 40% ,波形 是 否 互 补 。 注 意 , 要 单 击 图 5. 63 右上 方 的 实时 刷新 按钮 ， 
否则 数据 不 会 变化 。 


cum 


图 5.63 "— 
5.4.3 ePWM 中 断 
PWM 中 断 配 置 在 5.4. 2 158] PWM 实验 的 基础 上 改动 。 在 前 面 的 配置 不 变 的 情况 


下 ,在 Event Trigger 选项 卡 中 ,使 能 ePWM 中 断 , 并 配置 为 在 第 一 个 事件 发 生 时 就 进入 中 
断 , 其 他 设置 默认 。 配 置 如 图 5. 64 所 示 。 


CEA ADC start of conversion for module A 
Ë Enable ADC start of conversion for module B 
Enable ePWM interrupt 


Number of event for interrupt to be generated: rm— 
Inerrupt counter match event condition: [Gnome demi 


图 5.64 ePWM 中 断 配 置 


在 上 述 配置 完成 后 ,调用 C28x Hardware Interrupt 模块 ,将 PWMI 中 断 的 CPU 级 中 
断 号 3 以 及 PIE 级 中 断 号 1 AL ,其 余 配 置 默 认 , 如 图 5.65 所 示 。 


|| Simulink task priorities: 
Eoo 
HI 

| Preemption flags: preemptible-; 
` T 


|] E Enable simulation input 


图 5.65 中 断 模块 配置 
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中 断 函 数 中 ,使 用 StateFlow 搭建 了 一 个 简单 的 逻辑 功能 模块 ,使 LED 灯 每 秒 翻转 一 
次 。 其 中 计数 器 计数 最 大 值 为 1000 ,如 图 5. 66 所 示 。 


S 


Trigger 


图 5.66 中 断 函 数 


该 模型 的 系统 时 钟 为 80MHz, 定 步 长 为 0. 5s。 完 成 上 面 的 配置 之 后 ,将 生成 的 代码 下 
载 到 开发 板 上 ,可 以 看 到 ,在 PWM 波 产生 的 同时 ,LED2 灯 在 以 1Hz 的 频率 闪烁 ,LED1 灯 
以 每 0. 5s 的 频率 闪烁 ,如 图 5. 67 所 示 。 
输出 频率 为 IkHz， 古 空 比分 别 为 60% 、40% 的 脉冲 信号 


图 5.67 ePWM 中 断 实现 


5.5 eCAP 


5.5.1 eCAP 基本 介绍 


TMSS320F28069 的 捕获 单元 模块 能 够 捕获 外 部 输入 引 脚 的 逻辑 状态 ( 电 平 的 高 或 低 、 
电 平 翻转 时 的 上 升 沿 或 下 降 沿 ) ,并 利用 内 部 定时 器 对 外 部 事件 或 者 引 脚 状态 变化 进行 处 
理 。 控 制 器 给 每 个 捕获 单元 模块 都 分 配 了 一 个 捕获 引 脚 ,在 捕获 引 脚 上 输入 待 测 波形 ,捕获 
模块 就 会 捕获 到 指定 捕获 的 逻辑 状态 ,所 以 捕获 单元 可 以 用 于 测量 脉冲 周期 以 及 脉冲 的 宽 
度 。TMS320F28069 上 面 有 4 路 增强 型 捕捉 模块 eCAP,CAP 模块 是 应 用 定时 器 来 实现 事 
件 捕 获 功能 的 ,主要 应 用 在 速度 测量 、 脉 冲 序列 周期 测量 等 方面 。 

eCAP 模块 包括 以 下 资源 。 

。 可 分 配 的 输入 引 脚 。 

* 32b 时 间 基 准 (计数 器 ) 。 

e 4 个 32b 时 间 窗 捕获 控制 寄存 器 。 

。 独立 的 边缘 极 性 选择 。 
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` 输入 信号 分 频 (2 一 62) 。 

。 4 个 捕获 事件 均 可 引起 中 断 。 

1. eCAP 模块 的 组 成 

eCAP 模块 可 以 设置 为 捕捉 模式 或 者 是 APWM 模式 ,一 般 而 言 ,前 者 比较 常用 ,因此 在 
这 里 只 对 第 一 种 情况 进行 分 析 介 绍 。 在 捕捉 模式 下 ,一般 可 以 将 eCAP 模块 分 为 以 下 几 部 
分 : 事件 分 频 ,边沿 极 性 选择 与 验证 .中断 控 制 。 

1) 事件 分 频 

输入 事件 信号 可 通过 分 频 器 分 频 处 理 (分 频 系 数 2 一 62) ,或 直接 跳 过 分 频 器 。 这 个 功 
能 通常 适用 输入 事件 信号 频率 很 高 的 情况 。 

2) 边沿 极 性 选择 与 验证 

4 个 独立 的 边沿 极 性 (上 升 沿 / 下 降 沿 ) 选 择 通道 ，Modulo4 序列 发 生 器 对 Eachedge( 共 
4 路 ) 进 行事 件 验 证 ; CAPx 通过 Mod4 对 事件 边沿 计数 ,CAPx 寄存 器 在 下 降 沿 时 被 装载 。 
32b 计数 器 (TSCTR) 此 计数 器 为 捕捉 提供 时 钟 基准 ,而 时 钟 的 计数 则 是 基于 系统 时 钟 的 。 
当 此 计数 器 计数 超过 范围 时 , 则 会 产生 相应 的 溢出 标志 , 若 溢 出 中 断 使 能 , 则 产生 中 断 。 此 
计数 器 在 计算 事件 周期 时 非常 有 效 , 关 于 CAP 的 详细 资料 请 参阅 数据 手册 。 

3) 中 断 控 制 

中 断 能 够 被 捕获 事件 (CEVT1 一 CEVT4、CTROVE) 触 发 ,计数 器 (TSCTR ) 计 数 溢 出 
同样 会 产生 中 断 。 事 件 单独 地 被 极 性 选择 部 分 以 及 序列 验证 部 分 审核 。 这 些 事件 中 的 一 
被 选择 用 来 作为 中 断 源 送 入 PIE, 

设置 CAP 中 断 的 过 程 可 表述 如 下 。 

(1) 关闭 全 局 中 断 。 

(2) 停止 eCAP 计数 。 

(3) 关闭 eCAP 的 中 断 。 

(4) 设置 外 设 寄存 器 。 

(5) 清除 eCAP 中 断 标志 位 。 

(6) 使 能 eCAP 中 断 。 

CD 开启 eCAP 计数 器 。 

(8) 使 能 全 局 中 断 。 

2. 加 深 理解 eCAP 模块 原理 

配置 好 eCAP 模块 的 引 脚 后 ,外 部 事件 由 引 脚 输入 ,首先 通过 模块 的 分 频 部 分 ,分 频 系 
数 为 2 一 62, 也 可 以 选择 跳 过 分 频 部 分 ,此 功能 主要 是 针对 输入 事件 信号 频率 很 高 的 情况 。 
经 过 分 频 后 的 信号 (通常 频率 会 降低 ) , 送 至 边沿 及 序列 审核 部 分 ,边沿 审核 即 设置 为 上 升 沿 
或 下 降 沿 有 效 ,序列 审核 则 是 指 分 配 当 前 对 哪个 寄存 器 (CAP1~CAP4) 作 用 的 问题 ,之 后 
就 是 中 断 执 行 控制 部 分 。 
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5.5.2 eCAP 捕获 PWM 脉冲 


在 5.4 节 中 知道 了 如 何 配置 TMS320F28069 的 ePWM 模块 使 其 输出 PWM 波形 ,而 
本 实验 则 是 通过 利用 捕获 模块 功能 来 测量 配置 的 PWM 波 的 占 空 比 是 否 正确 。 实 验 时 ,只 
需要 将 ECAP1 引 脚 用 杜邦 线 先后 与 EPWMIA 引 脚 和 EPWMIB 连接 起 来 , 即 可 完成 实 
验 。 其 原理 图 如 图 5.68 所 示 。 

第 一 步 ,在 Solver 中 设置 定 步 长 为 0. 5s, 在 Hardware Implementation 中 配置 系统 时 
钟 为 900MHz,LSPCLK 低速 时 钟 外 设 4 分 频 ,eCAP 的 ECAPI pin assignment 引 脚 选择 
GPIO5 ,如 图 5.69 所 示 。 


图 5.69 eCAP 模块 配置 


第 二 步 , 初 始 化 好 10 个 全 局 变量 ,如 图 5. 70 所 示 。 用 来 实现 对 一 方 波 信号 的 频率 、 周 


期 、 占 空 比 的 测量 。 
= 


Data Store Store Data Store Data Store Store 
Memory Memory2 Memory? Mernory8 
Memory6 Memory3 Memory4 Memory5 Memory9 


图 5.70 变量 初始 化 


(1) tl 表示 第 一 个 捕捉 事件 发 生 时 计数 器 的 值 。 

(2) 12 表示 第 二 个 捕捉 事件 发 生 时 计数 器 的 值 。 

(3) t3 表示 第 三 个 捕捉 事件 发 生 时 计数 器 的 值 。 

(4) TI 表示 t2— t1 的 差 ,也 就 是 测试 方 波 的 高 电 平 时 间 对 应 的 计数 值 。 

(5) T2 表示 t3— t1 的 差 , 也 就 是 测试 方 波 的 整个 周期 对 应 的 计数 值 。 

(6) CLK 表示 系统 时 钟 周期 ,Duty 表示 实际 方 波 的 占 空 比 , Frequence 表示 方 波 的 频 
率 ,Period 表示 方 波 的 周期 , Flag 表示 检测 完成 标志 位 。 

第 三 步 , 生 成 两 路 频率 为 10kHz, 一 个 是 占 空 比 为 50% 的 PWM, 另 一 个 是 占 空 比 为 
60% 的 PWM, 如 图 5.71 所 示 。 

第 四 步 , 设 置 eCAP 模块 ,中 断 中 配置 如 图 5. 72 和 图 5. 73 所 示 , 使 用 的 是 eCAPI BE 
块 , 配 置 为 连续 控制 模式 ,并 在 第 三 次 事件 之 后 停止 计数 并 重 置 ,第 一 次 事件 的 触发 极 性 为 
上 升 沿 ,第 二 次 事件 的 触发 极 性 为 下 降 沿 , 第 三 次 触发 极 性 为 上 升 沿 ,计数 时 间 的 数据 类 型 
为 无 符号 的 32 位 整 型 。 中 断 配置 为 捕捉 到 第 三 次 事件 之 后 触发 中 断 。 在 eCAP 输出 接 上 
demux 模块 ,并 将 输出 的 值 赋予 01.12.13. 
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C2806x 


Wm 
GPIO DO 


GPIO31_Blue 


C2806x 


图 5.71 ePWM 模块 配置 


os。 。 t 表 示 第 一 个 捕捉 事件 发 生 时 计数 器 的 值 
a 避 表 示 第 二 个 捕捉 事件 发 生 时 计数 器 的 什 
omm. 。 6 表示 第 三 个 捕捉 事件 发 生 时 计数 器 的 值 


eCAP1_GPI05 


图 5.72 eCAP 模块 搭建 


Gea < ie 


Event prescaler (integer from 0 to 3D: -一 一 一 一 
Select mode control: 


Operating mode: ; T Stop value after 


eCAPz pin [Enable reset counter after capture event 1 time-stamp 


Counter phase offset value (0 " 4204967295): b Select capture event 1 polarity: 


Sync output. selection: [17 ^57 M NM EN C Select capture event 2 polarity: 


Sample time: a C Enable reset counter after ci 


Vei e” Select capture event 3 polarity:]| 
oett mE TEE =. Time-Stamp counter data type: 


Cl Post interrupt on capture event 2 O Enable capture event status flag output 
E Post interrupt on capture event 3 
C Post interrupt on counter overflow 


C Enable counter Sync-In mode L] Enable reset counter after 


O Enable overflow status flag output 


Counter phase offset value (0 ` 4294967295): 
C Enable counter Sync-In mode C Enable reset counter after captu 
Sync output selection: jua 77 07 T Select capture event 2 polarity:li 

Sample tine: [I =. reset counter after cam 


Tise-Stamp counter data type: 


O Pest PRA on capture eveni 


C Post interrupt on capture event 2 C Enable capture event status flag output 
E Post interrupt on capture event 3 O Enable overflow status flag output à | 
D) Post. interrupt on counter overflow < Vo SPRINTER CR ENIM REOR 


图 5.73 eCAP 模块 配置 
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第 五 步 ,计算 Tl1、T2 并 对 Flag 置 位 ,表示 一 次 检测 完毕 ,如 图 5.74 所 示 。 


X: 
iE: Flag 为 标志 位 ， 作 为 while 子 系统 的 触发 信号 
图 5.74 计算 Tl,T2 


第 六 步 , 封 装 子 系统 ,配置 硬件 中 断 ,根据 eCAP1 
的 中 断 向 量 号 ( 它 属于 CPU 中 断 的 第 四 组 下 的 第 1 个 t—— 


VIE interrupt mahere: 


PIE 中 断 ) ,配置 C28x 硬件 中 断 模块 ,如 图 5.75 所 示 。 E sm 
第 七 步 ,标志 位 触发 ,在 Whlie(1) 中 触发 计算 模 fe 
块 ,对 输入 方 波 的 频率 、 周 期 , 占 空 比 进行 计算 ,如 Fe | 


图 5.76 所 示 。 其 中 , CLK = 1/90000000, 40K 5. 77 E578 (CAPERE 
所 示 为 eCAP 的 Simulink 模型 图 。 


图 5.76 PWM 参数 计算 


第 5 章 ”基础 应 用 |P 85 


LATE I. Gl 


ECAP1 INT Hardware Interrupt 


图 5.77 eCAP 实验 


这 里 需要 注意 一 点 ,请 在 Diagonostics 选项 卡 中 的 Data Validity 选项 中 ,将 Multitask 
data store 配置 为 none, 和 否则 会 出 现 如 图 5. 78 所 示 的 错误 。 


The blocks 'Examole4 CAP PMM/whilel/Data Store Read' and 
"&xomole4 CAP PWM/cap Interrupt/Caculate/Data Store WriteJ' are accessing the Data Store Memory 
block 'Examole4 CAP PWM/Flag'. The two blocks execute in different tasks, which can lead to a 
lack of data integrity in a multi-tasking, real-time environment. Consider adjusting the 
sample times of the blocks that access that data store. Alternatively, set the 'Configuration 
Parameters > Diagnostics > Data Validity > Multitask data store’ parameter to 'none' if the 
data store is accessed with an atomic operation, or if the tasks involved cannot preempt each 
other in the target system. 


Component Simulink | Category: Block diagram error 


图 5.78 错误 诊断 


在 上 述 配 置 完 成 ,并 完成 模型 的 搭建 后 ,将 模型 编译 下 载 到 主 控 板 ,然后 在 CCS rh TT 
开 模 型 生成 的 工程 文件 , 先 单 击 “ 编 译 ” 按 钮 网 ,再 单 击 “调试 ”按钮 滥 a ,然后 将 图 5. 79 
和 图 5. 80 中 的 10 个 变量 添加 到 Expressions 中 ,在 单 击 “运行 ?按钮 吏 ; 前 , 先 将 eCAP3 5| 
脚 用 杜邦 线 与 EPWMIA 引 脚 连接 起 来 。 然 后 再 单 击 “ 运 行 ” 按 钮 可 以 看 到 各 个 变量 的 值 。 
ZA EPWMIB 的 数值 ,ECAP1 引 脚 用 杜邦 线 与 EPWMIB 引 脚 连接 起 来 。 这 里 有 一 点 
点 误差 ,是 芯片 自身 问题 。 图 5.79 Jy EPWMIA 数据 监测 图 ,图 5. 80 为 EPWMI1B 数据 监 
测 图 。 


(x) Variables 6€ Expressions 2: M Registers É 而 日 | 生生 图 
Espression "P Ee mas x 
4 (fff Example4 CAP PWM DW struct <unnamed> 

69. CLK double 

09: Duty float 

69: Frequence float 

9: Period float 

09: t1 unsigned long 

t4: t2 unsigned long 

mW: t3 unsigned long 

b% T1 unsigned long 

t9- T2 unsigned long 


图 5.79  EPWMLIA 数据 监测 
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t> Variables é Expressions 2 Mif Registers bte xE) 
Expression Type Value 
4 (ff Example4 CAP PWM DW struct «unnamed » ICLK=1.11111111e-08,Duty=... 
b% CLK double 1.111111 11e-08 
09: Duty fioat 
bé Frequence float 
bh Period float 
btl unsigned long 
by t2 unsigned long 
Vs IL. D w 
W T1 unsigned long 
W: T2 unsigned long 
0% Flag unsigned int 


Él 5.80 EPWMIB 数据 监测 


5.6 SCI 串 行 通信 


5.6.1 SCI 通信 基本 原理 


SCI(Serial Communication Interface) 意 为 “ 串 行 通 信 接 口 ?, 是 相对 于 并 行 通 信 来 说 
的 ,是 串 行 通信 技术 的 一 种 总 称 ,最早 由 Motorola 公司 提出 。 它 是 一 种 通用 异步 通信 接口 ， 
与 MCS-51 的 异步 通信 功能 基本 相同 。 

SCI 模块 用 于 串 行 通信 ,如 RS422、RS485、RS232, 在 SCI 中 ,通信 协议 体现 在 SCI 的 数 
据 格 式 上 。 通 常 将 SCI 的 数据 格式 称 为 可 编程 的 数据 格式 ,原因 就 是 它 可 以 通过 SCI 的 通 
信 控 制 寄存 器 SCICCR 来 进行 设置 ,规定 通信 过 程 中 所 使 用 的 数据 格式 ,如 图 5.81 所 示 。 


ADD P 
PITT ERR e 


仅 在 地 址 模式 下 使 用 
图 5.81 典型 的 SCI 数据 帧 格式 


TMS320F28069 上 面 有 两 个 UART H: SCIA、SCIB。 本 实验 针对 SCIB. SCI 的 原理 
以 及 特点 如 下 所 述 。 

(1) 外 部 引 脚 。 

发 送 引 脚 : SCITXD, 接 收 引 脚 : SCIRXD。 

(2) 波 特 率 可 编程 。 

M BRR=0 Hf: 波 特 率 王 LSRCLK 一 ((BRR 十 1)X8) 。 

当 BRR=0 Bf; FRE —LSPCLK 716, 

(3) 数据 格式 。 

1 个 开始 位 ,1 一 8 个 数据 位 , 奇 校 验 / 偶 检 验 / 无 校 验 可 选 ,1 或 2 个 停止 位 。 

(4) 4 个 错误 检测 标志 : 校 验 、 溢 出 、 帧 、 断 点 检测 。 

(5) 全 双 工 和 半 双 工 模式 可 以 缓冲 接收 和 发 送 。 
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(6) 串口 数据 发 送 和 接收 过 程 可 以 通过 中 断 方式 或 查询 方式 。 

本 实验 选取 TMS320F28069 的 SCIB 模块 进行 实验 ,分 别 设置 GPIO15 和 GPIOSS fE 
为 SCIB 的 发 送 和 接收 功能 引 脚 ,并 配置 为 波 特 率 9600b/s.8 位 数据 位 ,1 位 停止 位 ,无 奇偶 
校 验 ,原理 图 如 图 5. 82 所 示 。 


Fd 5.82 SCIB 原理 图 


5.6.2 SCI 收发 数据 


在 Solver 中 设置 定 步 长 为 0. 1s. fE Hardware Implementation 中 配置 系统 时 钟 为 
90MHz.LSPCLK 低速 时 钟 外 设 4 4 .SCI B 的 字符 长 度 为 8 位 , 波 特 率 设 为 115000b/s， 
Tx 的 引 脚 设 为 GPIO58,Rx 的 引 脚 设 为 GPIO15. 如 图 5. 83 所 示 。 


Groups 
| Model Referencing Buld options x Enatie loopback 
| EUM Pm Suspension mode: Frae run 
» Generation 
» Coverage COMP Number of stop bix: 1 
HDL Code Generation eCAN A Party mode None 
ACH Character engh bsd B — ] 
ec Desired baud rate in ttp 
SCLA Baud rate prwacutar (BRR = (SCIHBAUD << 8) | SCILBAUO)] 23 
[Sci B Closest achievatie baud rate (LSPCLKABRR1)8) m bsisec. 117388 
"UN Communication mode. Pure data 
SPLB = 
eot" + Blocking mode. 
Watchdog Data byte order. Litia Encian 
GPO0 7 Pin assignment Tay: [GPG T 
Goni Perro [OPTE ] E 


= 


5.83 SCIB 模块 配置 


设置 SCI Receive 的 SCI module 为 B, 其 他 的 参数 默认 ,此 模块 负责 接收 串口 助手 发 送 
过 来 的 数据 ; SCI Transmit 的 SCI module 为 B, 如 图 5. 84 所 示 , 其 他 参数 默认 ,此 模块 负 
责 发 送 数据 给 串口 助手 。 

搭建 整个 模型 如 图 5. 85 所 示 ,控制 流程 为 :, SCI 接收 到 数据 与 53 比较 ,如 果 等 于 53 WI 
输出 1,1 大 于 0 则 输出 Counter Limited 的 数 (Upper limit 设 定 为 10, 当 累加 到 10 变 归 0 
重新 计数 ) ,否则 一 直 输 出 2. 
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Block Parameters: SCI Receive 


SCI Transmit 


Block Parameters: SC) Transmit x 
C28x SCI Transmit (mask) (link) 
Configures Serial Communication Interface (SCI) of the C2000 | 


| MCUs to transmit data via SCITXD pin. This enables 


asynchronous serial digital communications between the MCU 
and other connected peripherals. 


Parameters | 

SCI module: B | ees i) 

Additional package header: | 

= - 3! 

Initial output: 旧 | 

fo I Additional paekage terminator: | 

Action taken when connection times out: | ng |I | 

le time: M4 
=a ium [C] Enable transmit FIFO interrupt 

mi Output receiving status 
C] Enable receive FIFO interrupt | 
er | 


图 5.84 SCI 收发 配置 


Connter 
Limited 


53 为 十 进 制 数 ， 在 串口 助手 中 需要 转换 


为 十 六 进 制 数 ， 即 输入 35 即 可 校 验 数据 


GPIO12 


图 5.85 整个 模型 搭建 


在 上 述 配置 完成 ,并 完成 模型 的 搭建 后 ,将 模型 编译 下 载 到 主 控 板 。 

将 套件 中 附带 的 USB 线 一 端 与 计算 机 连接 ,并 将 另 一 端 插 到 智能 平衡 移动 机 器 人 套件 
中 主 控制 板 的 USB 插口 处 。 当 用 USB 直接 连接 计算 机 时 ,要 想 看 到 系统 识别 串口 ,需要 打 
开设 备 管理 器 ,选择 TI XDS100 ChannelB, 在 右键 快捷 菜单 中 选择 “属性 ”命令 ,在 “高 级 ” 选 
项 卡 中 选中 “加 载 VCP” 选 项 , 拔 掉 USB 连接 线 , 再 次 插入 时 将 显示 系统 已 经 识别 到 COM 
口 , 可 以 打开 串口 调试 工具 进行 下 一 步 实验 ,如 图 5. 86 Bros. 

接 下 来 打开 串口 狂人 软件 。 可 以 看 见 几 个 主要 的 部 分 ,如 图 5.87 所 示 。 

选择 对 应 的 端口 号 COMO , 波 特 率 为 115200b/s, 在 没有 发 送 数据 之 前 ,数据 接收 界面 
一 直 显 示 2 ,说明 搭 建 的 模型 是 正确 的 ,如 图 5. 88 所 示 。 
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TIXDST00 Channel B 


2 mnecosenm RE 
Ñ Bluetooth Hard Copy ||  SRUEERREGHUBQTO RESERVE 
Generic USB Hub ui 
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图 5.86 串口 配置 


| {09 04 00 01 02 03 04 05 06 07 08 09 QA 00 01 02 03 04 05 06 07 08 03 QA 00 


数据 接收 显示 弄 面 


| pem TEES 
sonos damp 3| 


图 5.88 串口 软件 显示 


在 左下 角 的 方 框 中 输入 35( 十 六 进 制 ) , 则 数据 接收 显示 界面 会 一 直 显 示 0—10 的 数 ， 
如 图 5. 89 所 示 。 
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F OA 00 01 02 03 04 05 06 07 08 09 0A 00 01 02 03 04 05 06 07 08 09 0A 00 01 
图 5.89 串口 软件 测试 
在 高 级 收 码 工具 栏 下 方 的 通道 设置 的 来 源 选择 提取 每 一 帧 ,然后 单 击 * 启 动 高 级 收 码 ” 
按钮 , 便 可 以 在 历史 数据 看 见 有 0 一 10 的 十 进 制 数 显示 ,如 图 5. 90 所 示 。 


dit IB A, (Serial Y 
| HRAT 
ES mm | mE) | a E Bub | mus | mee | mw € = 
厂 92 IHEX) 5 
数据 克 国 (10 进 制 ] = 
E Wa TEENE [e [ess ll sew | "ene [ ^^ 
bu ESI |r aian C 8Cb 码 || ”显示 上 限 [255 | 
| | r 带 符 号 位 (负数 为 补 码 ] | 
| 厂 单独 符号 ( 员 数 为 原 码 ] | mug [o — nm = 
| " 3 
| | r imes 2 ; 
41 € AERAR 
历史 数据 (10 进 制 |) — C MESH GEH) 
ippurrupnunrupnuuu dp EUN m 


[2019/4/5 223426]. E 
Hiis Sá 02 


T etlo 修正 | 0 
| turca 38 


LE ri ub 


在 波形 显示 界面 将 Y 轴 倍 率 设 为 10/ 格 ,周期 为 0.1/ 格 ,可 以 看 见 一 个 0 一 10 的 阶梯 
状 图 形 ,如 图 5. 91 所 示 。 
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5.7 SPI 串 行 通信 


5.7.1 SPI 概述 


SPI 即 Serial Peripheral Interface 是 高 速 同 步 串 行 输入 /输出 端口 , SPI 最 早 是 由 
Freescale( 原 属 Motorola) 公 司 在 其 MC68HCxx 系列 处 理 器 上 定义 的 一 种 高 速 同 步 串 行 接 
口 。SPI 目前 被 广泛 用 于 外 部 移 位 寄存 器 `.D/A、A/D、. 串 行 EEPROM LED 显示 驱动 器 等 
外 部 芯片 的 扩展 。 与 前 面 介 绍 的 SCI 的 最 大 区 别 是 ,SPI 是 同步 串 行 接口 。SPI 总 线 包 括 
1 根 串 行 同步 时 钟 信号 线 (SCI 不 需要 ) 以 及 2 根 数据 线 , 实 际 总 线 接口 一 般 使 用 4 根 线 , 即 
SPI HRH: 串 行 时 钟 线 .主机 输入 /从 机 输出 数据 线 、 主 机 输出 /从 机 输入 数据 线 和 低 电 平 
有 效 的 从 机 片 选 线 。 有 的 SPI 接口 带 有 中 断 信号 线 , 有 的 SPI 接口 没有 主机 输出 /从 机 输入 
线 。 在 TMS320F28069 中 使 用 的 是 前 面 介绍 的 SPI 四 线 制 。 

SPI 接口 的 通信 原理 简单 ,以 主 从 方式 进行 工作 。 在 这 种 模式 中 ,必须 要 有 一 个 主 设 
备 ,可 以 有 多 个 从 设备 。 通 过 片 选 信 号 来 控制 通信 从 机 ,SPI 时 钟 引 脚 提供 串 行 通信 同步 时 
钟 ,数据 通过 从 入 主 出 引 脚 输出 ,从 出 主人 引 脚 输入 。 通 过 波 特 率 寄存 器 设置 数据 速率 。 
SPI 向 输入 数据 寄存 器 或 发 送 缓冲 器 写 人 数据 时 就 启动 了 从 人 主 出 引 脚 上 的 数据 发 送 , 先 
发 送 最 高 位 。 同 时 ,接收 数据 通过 从 出 主人 引 脚 移入 数据 寄存 器 最 低位 。 选 定数 量 位 发 送 
结束 , 则 整个 数据 发 送 完毕 。 收 到 的 数据 传送 到 SPI 接收 寄存 器 , 右 对 齐 供 CPU 读 取 。 
SPI 的 通信 链接 如 图 5. 92 所 示 。 

TMS320F28069 的 SPI 接口 具有 以 下 Spig #l-Master 
特点 。 

1. 4 个 外 部 引 脚 Gres; (seen 

* SPISOMI; SPI 从 输出 / 主 输入 引 脚 。 时 钟 
e SPISIMO: SPI 从 输入 / 主 输出 引 脚 。 图 5.92 ”SPI 通 信和 原理 
。 SPISTE: SPI 从 发 送 使 能 引 脚 。 
。 SPICLK: SPI 串 行 时 钟 引 脚 。 
2. 2 种 工作 方式 : 主 和 从 工作 方式 
波 特 率 : 125 种 可 编程 波 特 率 。 


‘SPI 器 件 82-Slave 


x 一 3 一 127 Bf i — LSPCLK _ 
当 SPIBRR 王 3 一 127 ËB EFE. : D° 
= SPIBR =0,1,2 时 , 波 特 率 = MAD 


数据 字 长 : 可 编程 的 1 一 16 个 数据 长 度 。 

3. 4 种 计时 机 制 (由 时 钟 极 性 和 时 钟 相应 控制 ) . 

(1) 无 相位 延 时 的 下 降 沿 : SPICLK 为 高 电 平 有 效 。 在 SPICLK 信号 的 下 降 沿 发 送 数 
据 , 在 SPICLK 信号 的 上 升 沿 接收 数据 。 
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(2) 有 相位 延 时 的 下 降 沿 : SPICLK 为 高 电 平 有 效 。 在 SPICLK 信号 的 下 降 沿 之 前 的 
半 个 周期 发 送 数据 ,在 SPICLK 信和 号 的 下 降 沿 接收 数据 。 

(3) 无 相位 延迟 的 上 升 沿 : SPICLK 为 低 电 平 有 效 。 在 SPICLK 信号 的 上 升 沿 发 送 数 
据 , 在 SPICLK 信号 的 下 降 沿 接收 数据 。 

(4) 有 相位 延迟 的 上 升 沿 : SPICLK 为 低 电 平 有 效 。 在 SPICLK 信号 的 下 降 沿 之 前 的 
半 个 周期 发 送 数据 ,而 在 SPICLK 信和 号 的 上 升 沿 接收 数据 。 

。 接收 和 发 送 可 同时 操作 (可 以 通过 软件 屏蔽 发 送 功能 ) 。 

° 通过 中 断 或 查询 方式 实现 发 送 和 接收 操作 。 

。 9 个 SPI 模块 控制 寄存 器 : 位 于 控制 寄存 器 内 , 帧 开始 地 址 7040H。 

注意 : 这 个 模块 中 的 所 有 寄存 器 是 被 连接 至 外 设 帧 2 的 16 位 寄存 器 。 当 一 个 寄存 器 
被 访问 时 , 低 字 节 (7 一 0) 和 高 字 节 (15 一 8) 内 的 寄存 器 数据 被 读 作 零 。 对 高 字 节 的 写 入 没有 
效果 。 

4. 增强 型 特性 
4 级 发 送 / 接 收 FIFO., 
经 延迟 的 发 射 控制 。 
支持 双向 3 线 SPI 模式 。 
借助 SPISTE 翻转 的 音频 数据 接收 支持 。 


5.7.2 SPI 控制 PWM 占 空 比 


第 一 步 , 在 Solver 中 设置 定 步 长 为 0.05s, 在 Hardware Implementation 中 配置 系统 时 
钟 为 90MHz, LSPCLK 低速 时 钟 外 设 4 分 频 , 主要 设置 SPI_A 的 Enable loopback ,将 
SIMO pin assignment, SOMI pin assignment\CLK pin assignment, STE pin assignment 这 
4 个 引 脚 配置 为 如 图 5.93 所 示 的 I/O 口 。 


* — 
Dala Impori/Export | 
Math and Data Types | Os 
=== Pss Desired baud rate in bits/sec: 821600 
parci. COMP Baud rate factor (SPIBRR: between 3 and 1; 
+ Code Generation eCANA 
|> Coverage cae 一 一 
HDL Code Generation epYM 
I "ac 
| CEN 
1 eQEP 
SPOT _ 
GPIOB (5 — 
GPiot6 23 
GPIO24 31 


图 5.93 SPIA 配置 


第 二 步 ,搭建 占 空 比 选择 子 系统 ,如 图 5. 94 Bros ,关于 MASK 子 系统 的 介绍 可 以 
查看 网 页 : https://ww2. mathworks. cn/help/simulink/gui/mask-editor-overview. html? 
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searchHighlight— Mask 9$ 20Editor % 20O0verviewG.s tid— doc. srchtitle, 


图 5.94 占 空 比 配置 


第 三 步 ,选择 SPI Transmit 和 SPI Receive 的 模块 为 SPI_A ,如 图 5.95 所 示 , 其 他 参数 


默认 。 
SPI Transmit =# 


SPI Receive ` 
R. —. Ei ] 
| Bil sx Block Parameters: SPI Transmit x [ril block Parameters: SPI Receive x| 
Transam: FEED SPI Receive 
Lt data eH sters of a SPI device. a ads. ne denen s 
ha an SPI write. starting with the SPI register 
Initiate an SPI a sequence starting with the SPI register | i Leypa rota: Ard bead pale vond Paese decer dnte: of 
sdáress followed b br eoe gest | "D 
| | The block outputs the valusa received n an (Nx1] array of 
[arde ciet rain ic eit m eder cd i | [type uintia. | 
data type wint}6. | K vens | 
os " EE — — 7 
SPI module -| 
Clock polarity: ESTARE Mi | data length: [1 — Ti] 
| Wes CHAM C ji 
sk pus | a: Enable blocking moda 
|C] Enable blocking mode pm Š "n mi 
I TO 
n CEN Essl rss um E TS OE 


图 5.95 收发 配置 


第 四 步 , 配 置 PWM 输出 ,定时 器 计数 次 数 为 64000, 计 数 方式 为 向 上 计数 UP, 不 分 频 。 

使 能 ePWMI1A, 当 计数 值 等 于 定时 器 周期 值 PRD 时 置 低 , 当 计 数值 等 于 向 上 计数 的 
CAU 时 置 高 ,其 他 计数 为 Do nothing( 不 动作 )。 

使 能 ePWM1B, 当 计数 值 等 于 定时 器 周期 值 PRD 时 置 高 , 当 计 数值 等 于 向 上 计数 的 
CBU 时 置 低 ,其 他 计数 为 Do nothing( 不 动作 ) 。 


比较 计数 ,选择 Clock cycles,CMPA initial value, CMPB initial value 的 值 由 外 部 输入 
初 值 为 0, 如 图 5.96 所 示 。 


第 五 步 , 在 上 述 配置 完成 ,并 完成 模型 的 搭建 后 ,如 图 5. 97 所 示 。 选 择 占 空 比 为 75%， 
将 模型 编译 下 载 到 主 控 板 。 

第 六 步 ,然后 在 CCS 中 打开 模型 生成 的 工程 文件 , 先 单 击 “ 编 译 ” 按 钮 & > ,再 单 击 “ 调 
A IRH de ,然后 将 图 5.98 中 的 两 个 变量 添加 到 Expressions 中 , Bñ d; "38 £7" TH üe. ,可 
以 看 到 TBPRD,CMPA ,CMPB 的 值 。 可 以 将 主 控 板 的 PWMIA 引 脚 和 PWM1B 引 脚 分 别 


连接 到 示波器 的 信号 线 , 主 控 板 和 示波器 记得 要 共 地 , 便 能 观测 到 两 路 PWM 的 频率 是 否 都 
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Compare value reload condition: 


C] Add continuous sofiwsre force input port 
Continuous software force logic: 


Holood condition for software force: RETE TORINO UN: 


[ Specify software synchronization via input port (SWFSYNC) 
口 Enable digital compare A event] synchronization (DCAEVTI) 


| specify GPA vin:]i 

w CHPA initial value: 
bj 
Reload for compare A Register (SHDWAMODU : 
CNPO unita: 
Specify CMPII via: npa 
CMPB initial valuo: 
E 


图 5.96 ePWM 配置 


SP-Based Control of PWM Duty Cycle 


图 5.97 整个 模型 搭建 


图 5.98 两 路 PWM 的 占 空 比分 别 为 ?75% ,25% 
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为 1kHz, 占 空 比 是 否 分 别 为 75% 和 25% ,波形 是 否 互 补 。 注意, 要 单 击 右 上 方 的 实时 刷新 
按钮 ,否则 数据 不 会 变化 

第 七 步 , 在 Simulink 中 选择 占 空 比 为 50% ,重新 编译 下 载 ,然后 在 CCS 中 观察 数据 ,如 
图 5.99 所 示 


(x Variables 6X Expressions 32 II Registers r. 4 € | $ x (9) 
Expression Type Value 

t9 EPwm1Regs-TBPRD unsigned int 64000 

bt EPwmlRegs.CMPA.hal.CMPA unsigned int 32000 

bh- EPwmiRegs.CMPB unsigned int 32000 


dp Add new expression 


图 5.99 两 路 PWM 的 占 空 比 都 为 5 
第 八 步 ,在 Simulink 添加 两 个 Scope. Al] 5. 100 所 示 ,选择 External 模式 , 主 控 板 连 
接 USB 转 TTL 模块 ,选择 对 应 的 COM H , 波 特 率 为 115200b/s, 选 择 占 空 比 为 75%, 单 击 
“运行 ”按钮 ,可 以 观测 Scopel 的 数据 是 否 和 Scope 的 数据 一 致 ,在 运行 状态 下 可 以 改变 占 
空 比 的 大 小 ,查看 Scopel 的 数据 变化 ,如 图 5. 101 所 示 
SPI-Based Control of PWM Duty Cycle 
EE = 5 
CJ 
a t3 


GPIO3! Blue 
图 5. 100 模型 图 
$ Scopel pej "y E Uu 
Fe foca View Simulaton Heip ` 
9-00 »-a-iZ2-4f4i4&4- 


Sampie based Offnets270 T«275800 | 


图 5.101 波形 图 
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5.8 ldelTask 模块 介绍 


在 常规 的 MCU 编程 中 , Whlie(1) 是 几乎 都 会 使 用 到 的 一 个 函数 , 它 可 以 使 一 些 对 工作 
周期 要 求 不 高 的 外 设 对 所 要 执行 的 功能 进行 循环 扫描 ,例如 ,矩阵 键盘 或 者 OLED 显示 等 
功能 。 在 TI 提供 的 硬件 支持 包 中 ,也 很 人 性 化 地 提供 了 这 个 功能 模块 一 一 1dle Task, jË 
加 Idle Task 模块 后 生成 的 代码 如 下 。 


Idle Task 模块 的 配置 界面 如 图 5. 102 所 示 ,分 别 设置 Task numbers 以 及 Preemption 
flags, - 


Idle Task 
Idle Task! 


这 里 的 抢占 式 优 先 级 不 同 于 中 断 的 抢占 式 优先 级 。 它 的 功能 是 : 当 Preemption flag 
设置 为 0 的 时 候 , 每 次 进入 Whlie 循环 的 开始 , 关 掉 全 局 中 断 ,执行 完毕 后 打开 。 当 
Preemption flag 设置 为 1 时 , 则 不 做 上 述 处 理 , 当 中 断 来 临时 ,优先 执行 中 断 。 

下 面 为 Preemption flag 设置 为 的 0 时 生成 的 代码 ,可 以 看 到 生成 的 代码 中 出 现 了 开关 
中 断 的 指令 ,而 从 Preemption flag 设置 为 1 时 的 生成 代码 可 以 看 到 ,没有 开关 中 断 的 指令 。 


qur 


LE 
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所 以 在 使 用 的 时 候 , 可 以 根据 自己 的 需要 选择 。 搭 建 如 图 5. 103 所 示 模 型 ,左边 子 系统 
是 给 GPIO31 一 个 高 电 平 ,右边 子 系统 是 给 GPIO25 一 个 低 电 平 , 电 平 不 翻转 。 编 译 下 载 可 
以 观察 主 控 板 的 LED1 灯亮 ,LED2 IK. 


图 5.103 模型 搭建 


下 面 为 该 模型 生成 的 代码 ,idle_num1_task_fcn() 函 数 为 图 5.103 中 右边 子 系 统 生成 的 
代码 ,idle_num2_task_fcn() 函数 为 左边 子 系统 生成 的 代码 。 
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可 以 从 Idletask. h 头 文件 代码 中 看 到 当 Constant. Value Jy 0. LED2 4T X , Constant _ 
Value a X 1, LEDI 灯亮 。 
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5.9 WatchDog 模块 介绍 


意外 难免 会 发 生 ,部 分 意外 发 生 的 时 候 , 系 统 程序 会 跑 飞 或 进入 死 循 环 , 系 统 需要 有 一 
定 自 恢复 的 功能 ,这 就 需要 看 门 狗 。 意 外 有 很 多 ,对 强 电 类 控制 电路 来 说 ,最 让 人 头疼 的 就 
是 琢磨 不 透 又 抓 不 着 的 EMI 干扰 ,以 及 电源 设计 ,对 于 软件 而 言 有 内 存 汇 漏 、 程 序 健 壮 性 等 
问题 。 看 门 狗 (Watchdog timer) 从 本 质 上 来 说 就 是 一 个 定时 器 电路 ,一 般 有 一 个 输入 和 一 
个 输出 ,其 中 的 输入 叫 作 喂 狗 ,输出 一 般 连 接 到 另外 一 个 部 分 的 复位 端 ,在 这 里 就 是 
TMS320F28069 的 复位 端 。CPU 工作 正常 时 ,按照 设 定 的 程序 ,每 隔 一 段 时 间 就 输出 一 个 
信号 到 喂 狗 端 ,实际 操作 是 给 看 门 狗 计 数 器 清 零 ,如果 超过 了 一 定时 间 没 有 信号 到 喂 狗 端 进 
行 喂 狗 ,来 做 清 零 操 作 ,一 般 就 认为 程序 运行 出 了 意外 ,不 管 意 外 类 型 是 怎样 的 ,这 时 候 看 门 
狗 电 路 就 会 给 出 一 个 复位 信号 给 CPU 的 复位 端 ,使 CPU 强制 复位 ,从 而 可 能 改变 程序 跑 
飞 或 死 循环 的 状态 。 设 计 者 必须 了 解 看 门 狗 的 溢出 时 间 以 决定 在 适当 的 时 候 清 看 门 狗 。 清 
看 门 狗 也 不 能 太 过 频繁 ,否则 会 造成 资源 浪费 。 在 系统 设计 初 以 及 调试 的 时 候 , 不 建议 使 用 
看 门 狗 , 因 为 系统 设计 初 的 时 候 意外 的 可 能 性 太 多 , 且 有 些 意外 是 必须 处 理 的 ,看 门 狗 电 路 
的 复位 信号 很 可 能 会 引入 更 多 的 困扰 。 合 理 利 用 看 门 狗 电 路 ,可 以 检测 软件 和 硬件 运行 的 
状态 ,进一步 提高 系统 的 可 靠 性 。 

在 使 用 看 门 狗 之 前 首先 要 对 看 门 狗 的 内 部 计数 器 进行 配置 。 打 开 模 型 配置 界面 ,在 
Watchdog 选项 卡 中 ,使 能 看 门 狗 ,再 配置 看 门 狗 计 数 器 的 计时 时 间 为 0.209715s 触发 一 次 
Time out event( 从 配置 中 可 以 看 到 ,看 门 狗 的 时 钟 直接 来 自 OSCCLK 也 就 是 外 部 晶振 的 时 
钟 10MHz) ,然后 配置 Time Out event 为 Chip reset。 具 体 配置 如 图 5. 104 所 示 。 


图 5.104 看 门 狗 模 块 
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将 看 门 狗 模 块 的 复位 源 信号 设置 为 Timer0 中 断 的 周期 ,在 Sample time 中 填 入 一 1, 如 
图 5. 105 所 示 。 


C28x WatchDog (mask) (Link) 
Configures the Watchdog module an the DSP. 


C28x I 
-一 一 > 
WatchDog | 


WatchDog 


图 5.105 看 门 狗 模块 配置 


同时 在 Timer0 的 中 断 中 使 两 LED 的 电 平 在 中 断 中 翻转 。 模 型 如 图 5.106 所 示 。 


C28x 
WatchDog 


GPIO25 Red 


图 5.106 模型 搭建 


然后 可 以 做 两 次 对 比 性 实验 ,一 次 实验 的 系统 步 长 设置 为 0. 5s( 大 于 看 门 狗 的 溢出 时 
间 ), 男 一 次 设置 为 0.1s( 小 于 看 门 狗 的 溢出 时 间 )。 分 别 生 成 代码 之 后 下 载 到 开发 板 上 观 


从 图 5. 107 中 的 代码 可 以 看 到 ,每 进行 一 次 定时 器 中 断 , 便 将 看 门 狗 计数 器 复位 ,也 就 
是 所 说 的 喂 狗 。 
/* Model step function */ 
void WatchDog step(void) 
/* S-Function (c288xgpio do): '«Root»/GPIO25 Red' incorporates: 
* Constant: '«Root»/Constant" 
/ 
GpioDataRegs.GPATOGGLE.bit.GPIO25 = (WatchDog P.Constant Value !- 9); 
/* S-Function (c286xgpío do): '«Root»/GPIO31 Blue' incorporates: 
* Constant: '«Root»/Constant' 
* 


š 
GpioDataRegs.GPATOGGLE.bit.GPIO31 = (WatchDog P.Constant Value t= 9); 
/* S-Function (c28xwatchdog): '«Root»/Watchdog' */ 
KickDog(); 
} 
} 


图 5.107 自动 生成 代码 
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在 对 比 实验 中 ,可 以 清楚 地 看 到 ,当中 断 周 期 大 于 看 门 狗 定 时 器 的 时 间 ,芯片 会 一 直 复 
位 ,LED 灯 无 法 按照 设 定 的 频率 翻转 ; 反之 则 LED 灯 正 常 工作 。 


5.10 本 章 小 结 


本 章 主 要 介绍 了 智能 平衡 移动 机 器 人 片 内 外 设 模 块 的 基本 原理 及 MATLAB/Simulink 
的 仿真 实验 ,包括 GPIO 模块 .ADC 模块 .Timer_IT 模块 . ePWM、eCAP X SCI 串 行 通信 和 
SPI 串口 通信 的 基本 原理 ,以 及 对 MATLAB/Simulink 系统 的 设置 过 程 , 并 结合 
MATLAB/Simulink 对 每 个 模块 进行 了 模型 搭建 实验 及 自动 代码 生成 。 


em 进 阶 应 用 


CHAPTER 6 


6.1 eCAP 超声 疲 测 距 


5.5 节 介 绍 了 TMS320F28069 eCAP 模块 的 工作 原理 以 及 如 何 配 eCAP 模块 ， 
并 利用 eCAP3 模块 结合 ePWMI 进行 了 对 PWM 波形 占 空 比 的 测量 。 本 章 利用 
TMS320F28069 的 eCAP 模块 结合 平衡 移动 机 器 人 的 超声 波 模块 HC-SR04 tit 如 何 进 行 
距离 检测 。 关 于 TMS320F28069 的 eCAP 模块 的 相关 知识 如 有 疑问 请 参考 5.6 节 的 应 用 
原理 说 明 。 

1. HC-SR04 基本 工作 原理 

。 RHIO H TRIG 触发 测 距 ,至少 给 10ys 的 高 电 平 信号 。 

。 模块 自动 发 送 8 个 40kHz 的 方 波 , 自 动 检测 是 否 有 信和 号 返回 。 

° 若 有 信号 返回 ,通过 1⁄/O O ECHO 输出 一 个 高 电 平 ,高 电 平 持续 的 时 间 就 是 超声 波 

从 发 射 到 返回 的 时 间 。 
° 测试 距离 =( 高 电 平 时 间 X340m/s)/2, 其 中 340m/s 为 声速 。 


2. 注意 事项 

。 此 模块 不 宜 带 电 连 接 , 若 要 带电 连接 , 则 先 让 模块 的 GND 端 先 连接 ,否则 会 影响 模 
块 的 正常 工作 。 

。 测 距 时 ,被 测 物 体 的 面积 不 少 于 0. 5m^ 且 平 面 尽 量 要 求 平 整 ,否则 影响 测量 的 
结果 。 


HC-SR04 模块 图 如 图 6. 1 所 示 , 左 为 正面 图 , 右 为 反面 图 。 


图 6.1 超声 模块 


第 6 章 ” 进 阶 应 用 |P 103 


本 模块 使 用 方法 简单 ,一 个 控制 口 发 一 个 10ps 以 上 的 高 电 平 ,就 可 以 在 接收 口 等 待 高 
电 平 输出 。 一 有 输出 就 可 以 开 定时 器 计时 , 当 此 口 变 为 低 电 平时 就 可 以 读 定时 器 的 值 , 此 值 
就 为 此 次 测 距 的 时 间 ,通过 该 时 间 可 算出 距离 。 如 此 不 断 进行 周期 性 测量 , 即 可 达到 移动 测 
量 的 值 , 其 工作 时 序 图 如 图 6. 2 所 示 。 
超声 波 时 序 图 ,: 
10hs 的 TTL 


触发 信号 
循环 发 出 8 个 40kHz 脉 冲 


图 6.2 超声 波 时 序 图 


故 只 要 用 TMS320F28069 的 eCAP1 引 脚 连接 到 HC-SR04 的 ECHO 引 脚 ,再 利用 一 
A 1/0 引 脚 ( 本 应 用 选取 GPIO4) 作 为 HC-SR04 的 触发 源 引 脚 ,其 原理 图 如 图 6. 3 所 示 。 


图 6.3 引 脚 图 


A 5.5 节 的 知识 便 可 以 通过 一 系列 数学 运算 测量 出 挡 板 到 HC-SR04 的 距离 。 下 面 
基于 应 用 模型 具体 介绍 。 

第 一 步 ,在 Solver 中 设置 定 步 长 为 0.5s, 在 Hardware Implementation 中 配置 系统 时 
钟 为 90MHz,LSPCLK 低速 时 钟 外 设 4 分 频 , 在 Diagonostics 选项 卡 的 Data Validity 选项 
中 ,将 Multitask data store 配置 为 none。 配 置 系统 时 钟 为 80MHz, ECAP1 引 脚 选择 
GPIO5( 见 图 6.4). 


v Target hardware resources 


Groups 


Bulld options. ECAP1 pin assignment: |GPIOS — — MEE ux J Iz 
EN ECAP2 pin assignment. [GPIOT d E Hi zh id iz) 
COMP ECAP3 pin assignment: [GPIO26 ` me Niere nl [zl 
eCAN A 


图 6.4 eCAP 配置 


第 二 步 ,初始 化 好 5 个 全 局 变量 , tl 表示 第 一 个 捕捉 事件 发 生 时 计数 器 的 值 ,t2 表示 第 
二 个 捕捉 事件 发 生 时 计数 器 的 值 ,T1 表示 t2 一 t1, 也 就 是 测试 方 波 的 高 电 平 时 间 对 应 的 计 
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数值 ,Distan 表示 超声 波 探测 到 离 物体 的 距离 ,Flag 作为 标志 位 。t1、t2、T1l 的 数据 类 型 为 
int32 ,Distan 为 single,Flag 为 uint8 ,如 图 6. 5 所 示 。 


图 6.5 定义 全 局 变量 


第 三 步 ,设置 eCAP 模块 ,中 断 配 置 如 图 6. 6 所 示 , 使 用 的 是 eCAP1 模块 ,配置 为 连续 
控制 模式 (Continuous) ,并 在 第 二 次 事件 之 后 停止 计数 并 重 置 ,第 一 次 事件 的 触发 极 性 为 上 
升 沿 (Rising Edge) ,第 二 次 事件 的 触发 极 性 为 下 降 沿 (Falling Edge) ,计数 时 间 的 数据 类 型 
为 无 符号 的 32 位 整 型 (int32)。 中 断 配 置 为 捕捉 到 第 三 次 事件 之 后 触发 中 断 。 在 eCAP 输 
出 接 上 Demux 模块 ,并 将 输出 的 值 赋予 t1 、t2, 如 图 6.7 所 示 。 


: w | 
= TS 
Patapi reset counter after capture event 2 time-stamp : 
select entare even 2 olio: RSS T =a 
Tise-Stamp counter duta type: EE 
图 6.6 eCAP 触发 事件 图 6.7 eCAP 设置 


第 四 步 ,计算 T1,Tl 表示 t2 一 蕊 ,也 就 是 测试 方 波 的 高 电 平 时 间 对 应 的 计数 值 ,并 对 
Flag 置 位 ,表示 一 次 检测 完毕 ,如 图 6.8 所 示 。 


图 6.8 高 电 平时 间 


第 五 步 , 同 5. 5. 2 节 中 的 第 五 步 。 

第 六 步 , 参 考 5. 5. 2 节 内 容 , 需 要 设置 Trig 引 脚 高 电 平 持续 的 时 间 , 超 声波 模块 HC- 
SR04 需要 至 少 10us 的 高 电 平 才能 开始 工作 ,本 应 用 给 15pss 计算 距离 ,声速 默认 为 340m/s， 
注意 此 单位 为 mm ,搭建 模型 如 图 6.9 所 示 。 i 

测试 距离 一 (高 电 平时 间 X(340my/s)72 
Distan 一 (高 电 平 计 数值 T1 340m/s)/2/80MHz-— T1 X 170/80000mm 
其 中 ,340mys 为 声速 。 


第 6 章 ” 进 阶 应 用 |P 105 


Trig 引 脚 输出 1Shs 高 电 平 


am 


数据 转换 
Distnan=(T1*340/2)*1000/80000000 检测 距离 ”单位 为 mm 


一 一旦 时 


GPIO25 Red 


图 6.9 距离 计算 
第 七 步 ,初始 化 GPIO4, 完 成 以 上 配置 ,搭建 模型 如 图 6. 10 所 示 。 


eid 


is. rey. 


图 6.10 初始 化 GPIO4 触发 引 脚 


第 八 步 ,将 模型 编译 下 载 到 主 控 板 ,然后 在 CCS 中 打开 模型 生成 的 工程 文件 , 先 单 击 
“编译 "按钮 Aon ,再 单 击 “ 调 试 ?按钮 et PARE Example21 CAP | Ultrasonic. DW. 
Distan 以 及 Example21 CAP Ultrasonic DW. Flag 这 两 个 变量 添加 到 Expressions 中 ,在 
dite fr ae 前 , 先 将 超声 波 传感器 插 在 连接 板 J3 或 J4 上 (J3、J4 并 联 )。 然 后 再 单 
ias fr" fL ae. 可 以 看 到 各 个 变量 的 值 , 用 纸 在 超声 波 传感器 的 前 方 移动 ,观测 Distan 的 
变化 是 否 和 实际 距离 一 致 ,如 图 6. 11 所 示 。 


BF Variables. é Expressions 32 if Registers EXEITJEX T1: 
Expression Type J Value. — 
1 (Xi Example21, CAP. Ultrasonic DW.Distan float [ 


09: Example21 CAP Ultrasonic DW.Flag unsigned int o aga 
db Add new expression 


* ee— HEU a e 
图 6.11 CCS 变量 观察 
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6.2 ePWM 电动 机 调 速 


直流 电源 的 电能 通过 电 刷 和 换 向 器 进入 电 枢 绕组 ,产生 电 枢 电 流 , 电 枢 电 流产 生 的 
磁场 与 主 磁场 相互 作用 产生 电磁 转 矩 ,使 电动 机 旋转 带动 负载 。 由 于 电 刷 和 换 向 器 的 存 
在 ,有 刷 直流 电动 机 的 结构 复杂 ,可靠 性 差 , 故 障 多 ,维护 工作 量 大 ,寿命 短 , 换 向 火花 易 
产生 电磁 干扰 。 

有 刷 直 流 电动 机 的 工作 原理 图 如 图 6. 12 Bron 。 


图 6.12 有 刷 直 流 电动 机 


在 有 刷 直 流 电动 机 的 固定 部 分 有 磁铁 ,这 里 称 其 为 主 磁极 ,固定 部 分 还 有 电 刷 。 转 动 部 
分 有 环形 铁 芯 和 绕 在 环形 铁 芯 上 的 绕组 。 如 图 6.12 所 示 的 两 极 有 刷 直 流 电动 机 的 固定 部 
分 (定子 ) 上 装 设 了 一 对 直流 励磁 的 静止 的 主 磁极 N 和 S, 在 旋转 部 分 (转子 ) 上 装 设 电 枢 铁 
芯 。 定 子 与 转子 之 间 有 一 气 隙 。 在 电 枢 铁 芯 上 放置 了 由 A 和 X 两 根 导 体 连 成 的 电 枢 线圈 ， 
线圈 的 首 端 和 末端 分 别 连 到 两 个 圆 弧 形 的 铜 片上 ,此 铜 片 称 为 换 向 片 。 换 向 片 之 间 互 相 绝 
缘 , 由 换 向 片 构成 的 整体 称 为 换 向 器 。 换 向 器 固定 在 转轴 上 , 换 向 片 与 转轴 之 间 亦 互相 绝 
缘 。 在 换 向 片上 放置 着 一 对 固定 不 动 的 电 刷 B1 和 B2, 当 电 枢 旋转 时 , 电 枢 线圈 通过 换 向 片 
和 电 刷 与 外 电路 接 通 。 电 动机 控制 框图 如 图 6.13 Bron 

AINI 和 AIN2 引 脚 控制 着 AOUT1 和 AOUT2 的 输出 ,同样 BIN1 和 BIN2 控制 着 
BOUT! 和 BOUT2 的 输出 ,其 作为 1/0 口 进行 控制 电动 机 时 ,其 控制 逻辑 如 表 6. 1 所 示 。 


表 6.1 电动 机 了 驱动 逻辑 表 


xINI xIN2 xOUTI xOUT2 功 能 
0 0 Z un 快速 移动 /迅速 减速 
0 j I H 反 转 
1 0 H I 前 进 
1 I I 


刹车 /缓慢 减速 
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图 6.13 电动 机 控制 框图 


当 利用 PWM 作为 输入 控制 电动 机 时 ,其 控制 逻辑 如 表 6. 2 Bron 。 
表 6.2 PWM 控制 电动 机 逻辑 表 


xIN1 xIN2 Jj 能 

PWM 0 正 向 脉 宽 调制 ,迅速 减速 
1 PWM 正 向 脉 宽 调 制 ,缓慢 减速 
0 PWM 反 向 脉 宽 调 制 ,迅速 减速 

PWM 1 反 向 脉 宽 调制 ,缓慢 减速 


电动 机 工作 在 PWM 输入 模式 ,其 原理 图 如 图 6. 14 所 示 。 l 

直流 电动 机 速度 是 由 功率 大 小 控制 的 ,所 以 它 是 由 占 空 比 决定 的 (当然 ,也 要 控制 频率 
跟 上 )。 电 动机 相关 知识 表述 如 下 。 

(1) 电动 机 和 减速 器 的 扭矩 (N。m) 王 电动 机 功率 /(2XrX 转 速 /60) 。 

(2) 占 空 比 是 指 直流 电动 机 在 一 个 通电 与 断 电 周期 中 其 通电 时 间 所 占 的 比例 , 占 空 比 
越 大 ,相对 提供 的 功率 越 小 。 

(3) 直流 电动 机 三 相 绕组 按照 规律 周期 性 通电 ,转速 越 高 ,通电 频率 越 高 。 

(4) 增 速 过 程 ( 据 上 述 第 (1)、(2)、(3) 条 进行 综合 分 析 ), 电 动机 扭矩 不 变 时 , 占 空 比 越 
小 ,提供 功率 越 大 ,转速 越 高 ,电动 机 绕组 通电 频率 越 高 ,导致 扭矩 有 所 增加 ,用 来 克服 加 速 
增加 的 阻力 ,直至 平衡 、 稳 速 。 

下 面 基 于 Simulink 模型 进行 介绍 。 

XT ePWM 模型 的 配置 在 5.4 节 已 经 详细 介绍 过 了 。 此 模型 的 系统 时 钟 为 80MHz, 
低速 时 钟 4 分 频 , 选 择 对 应 的 ePWMx, 要 得 到 频率 为 1kHz 的 PWM , 设 定时 钟 计数 次 数 为 
2000, 上 下 计数 ,时 基 时 钟 分 频 TBCLK 为 4 分 频 , 高 速 时 基 分 频 HSPCLKDIV 为 10 分 频 ， 
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tb6612 


图 6.14 电动 机 驱动 电路 图 


当时 基 计 数值 等 于 CAU 时 ,ePWMIA 输出 低 , 当 时 基 计 数值 等 于 CAD 时 ,ePWMIA 输出 高 ; 
当时 基 计 数值 等 于 CBU BF ePWMIB 输出 低 , 当 时 基 计 数值 等 于 CBD 时 ,ePWMI1B 输出 高 ; 
比较 寄存 器 CMPA 的 值 和 设 定 比 较 寄存 器 CMPB 的 值 ,本 应 用 初始 化 为 0。 

首先 查看 驱动 板 的 电动 机 接线 端口 以 及 电动 机 驱动 板 是 否 揪 接 正确 ,驱动 板 一 侧 电动 
机 线 接口 对 应 连接 相应 侧 电动 机 的 接口 。 

应 用 一 和 应 用 二 选择 的 是 ePWMI1, 应 用 三 和 应 用 四 选择 的 是 ePWM2。 分 别 将 4 个 应 


用 依次 下 载 到 主 控 板 中 ,观察 电动 机 的 转动 方向 是 否 如 图 6. 15 Bron. 


ada 
ú ePWM1-1 EB ePWM1-2 
Duy cycles 
owad! Duty cycle 范 围 : 20-100 Duty cyclel 范 围 : 20-100 
应 用 一 : 现象 为 右边 的 轮子 逆 时 针 旋 转 。 应 用 二 : 现象 为 右边 的 轮子 顺 时 针 旋 转 
Duty cyde4 
ePWM?2-1 

i M 

Duty cycle1 范 围 : 20-100 Duty cycle1 范 围 : 20~100 


应 用 三 : 现象 为 左边 的 轮子 逆 时 针 旋转 WAN: 现象 为 左边 的 轮子 顺 时 针 旋 转 
图 6.15 电动 机 转动 应 用 
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6.3 eQEP 正 交 解码 


6.3.1 正 交 编码 器 QEP 概述 


编码 器 是 一 种 将 角 位 移 或 者 角速度 转换 成 一 连 串 电 数字 脉冲 的 旋转 式 传感器 ,可 以 通 
过 编码 器 测量 到 位 移 或 者 速度 信息 。 编 码 器 从 输出 数据 的 类 型 上 分 ,可 以 分 为 增 量 式 编码 
器 和 绝对 式 编码 器 。 

从 编码 器 检测 原理 上 来 分 ,还 可 以 分 为 光学 式 、 磁 式 , 感 应 式 . 电 容 式 。 常 见 的 是 光电 编 
码 器 (光学 式 ) 和 和 霍 尔 编码 器 ( 磁 式 ) 。 

光电 编码 器 是 一 种 通过 光电 转换 将 输出 轴 上 的 机 械 几 何 位 移 量 转换 成 脉冲 或 数字 量 的 
传感器 。 光 电 编 码 器 由 光 码 盘 和 光电 检测 装置 组 成 。 由 于 光电 码 盘 与 电动 机 同 轴 , 电 动机 
旋转 时 ,检测 装置 检测 输出 若干 脉冲 信号 ,为 判断 转向 ,一 般 输出 两 组 存在 一 定 相 位 差 的 方 
iam. 

霍 尔 编码 器 是 一 种 通过 磁 电 转 换 将 输出 轴 上 的 机 械 几 何 位 移 量 转换 成 脉冲 或 数字 量 的 
传感器 。 霍 尔 编码 器 是 由 霍 尔 码 盘 和 霍 尔 元 件 组 成 。 霍 尔 码 盘 与 电动 机 同 轴 , 电 动机 旋转 
时 , 霍 尔 元 件 检测 输出 若干 脉冲 信号 。 为 判断 转向 ,一 般 输出 两 组 存在 一 定 相位 差 的 方 波 
信号 。 

光电 编码 器 是 集 光 、 机 、 电 技术 于 一 体 的 数字 化 传感器 ,通过 光电 转换 将 输出 轴 上 的 机 
械 几 何 位 移 量 转换 成 脉冲 或 者 数字 量 的 传感器 ,可 以 高 精度 测量 被 测 物 的 转角 或 直线 位 移 
量 , 是 目前 应 用 最 多 的 传感器 之 一 。 

它 具 有 分 辩 率 高 .精度 高 .结构 简单 体积 小 .使 用 可 靠 、. 易 于 维护 .性价比 高 等 优点 。 在 
数控 机 床 .机 器 人 、 和 雷达、 光电 经 纬 仪 . 地 面 指挥 仪 . 高 精度 闭环 调 速 系统 .伺服 系统 等 诸多 领 
域 中 得 到 了 广泛 的 应 用 。 典 型 的 光电 编码 器 由 码 静 (Disk) .检测 光栅 (Mask) .光电 转换 电 
路 (包括 光源 .光敏 器 件 .信号 转换 电路 )》、 机 械 部 件 等 组 成 ,如 图 6.16 所 示 。 


光源 6 sen E a" 
7 ° J ^ “a 
9 正弦 波形 方 波 
图 6.16 光电 编码 器 


一 般 来 说 ,根据 光电 编码 器 产生 脉冲 的 方式 不 同 ,可 以 分 为 增 量 式 、 绝 对 式 以 及 复合 式 
三 大 类 。 按 编码 器 运动 部 件 的 运动 方式 ,可 以 分 为 旋转 式 和 直线 式 两 种 。 由 于 直线 式 运动 
可 以 借助 机 械 连 接 转变 为 旋转 式 运动 ,反之 亦 然 。 因 此 ,只 有 在 那些 结构 形式 和 运动 方式 都 
有 利于 使 用 直线 式 光电 编码 器 的 场合 才 予 使 用 。 旋 转 式 光电 编码 器 容易 做 成 全 封闭 式 , 吻 
于 实现 小 型 化 , 传 感 长 度 较 长 ,具有 较 长 的 环境 适用 能 力 ,因而 在 实际 工业 生产 中 得 到 广泛 
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的 应 用 。 

增 量 型 编码 器 一 般 安 装 在 电动 机 或 其 他 旋转 机 构 的 轴 上 ,在 码 盘旋 转 过 程 中 ,输出 的 两 
个 信号 分 别 被 称 为 QEPA 与 QEPB, 两 路 信号 相差 90" ,这 就 是 所 谓 的 正 交 信号 , 当 电 动机 
正 转 时 ,脉冲 信号 A 的 相位 超前 脉冲 信号 B 的 相位 90" ,此 时 逮 辑 电路 处 理 后 可 形成 高 电 平 
的 方向 信号 Dir。 当 电动 机 反 转 时 ,脉冲 信号 A 的 相位 滞后 脉冲 信号 B 的 相位 90^ , IE SEE 
辑 电路 处 理 后 的 方向 信号 Dir 为 低 电 平 。 因 此 根据 超前 与 滞后 的 关系 可 以 确定 电动 机 的 
转向 。 

在 运动 控制 系统 中 ,不 仅仅 需要 获取 实时 的 速度 信息 ,有 时 候 为 了 精确 控制 ,也 需要 位 
置信 息 以 及 运动 方向 信息 , 工 MS320F28069 中 的 eQEP 模块 通过 正 交 解码 不 仅 可 以 获取 速 
度 信息 ,也 可 以 获得 方向 信息 以 及 位 置信 息 ,TMS320F28069 中 的 eQEP 模块 主要 针对 的 是 
增 量 型 光电 编码 器 。 

智能 平衡 移动 机 器 人 可 以 采用 集成 在 JGB37-520 减速 电动 机 上 的 增 量 式 霍 尔 编码 器 。 
这 是 一 款 增 量 式 输出 的 霍 尔 编码 器 。 编 码 器 有 AB 相 输 出 ,所 以 不 仅 可 以 测速 ,还 可 以 辨别 
转向 。 另 外 ,只 需 给 编码 器 电源 5V 供电 ,在 电动 机 转动 的 时 候 即 可 通过 AB 相 输 出 方 波 信 
号 。 编 码 器 自 带 了 上 拉 电 阻 , 所 以 无 须 外 部 上 拉 , 可 以 直接 连接 到 单片机 L/O 口 读 取 ,电动 
机 与 编码 器 AB 相 输 出 如 图 6. 17 所 示 。 


(a) 正 转 (b) 反 转 
图 6.17 增 量 式 霍 尔 编码 器 


6.3.2 光电 编码 器 电动 机 测速 的 基本 原理 


可 以 利用 定时 器 /计数 器 配合 光电 编码 器 的 输出 脉冲 信号 来 测量 电动 机 的 转速 。 具 体 
的 测速 方法 有 M 法 .T 法 和 M/T 法 3 种 。 I 

M 法 又 称 为 测 频 法 ,其 测速 原理 是 在 规定 的 检测 时 间 工 . 内 ,对 光电 编码 器 输出 的 脉冲 
信号 计数 的 测速 方法 ,例如 光电 编码 器 是 N 线 的 , 则 每 旋转 一 周 可 以 有 4N 个 脉冲 ,因为 两 
路 脉冲 的 上 升 沿 与 下 降 沿 正好 是 编码 器 信号 4 倍 频 。 现 在 假设 检测 时 间 是 T. ,计数 器 记录 
的 脉冲 数 是 Mi , 则 电动 机 每 分 钟 的 转速 可 表示 为 式 (6.1)。 
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15M, 
NT. 
在 实际 的 测量 中 ,时 间 T. 内 的 脉冲 个 数 不 一 定 正好 是 整数 ,而 且 存 在 最 大 半 个 脉冲 的 
误差 。 如 果 要 求 测量 的 误差 小 于 规定 的 范围 ,比如 说 是 小 于 百 分 之 一 ,那么 Mi 就 应 该 大 于 
50。 在 一 定 的 转速 下 要 增 大 检测 脉冲 数 M 以 减 小 误差 ,可 以 增 大 检测 时 间 T ,但 考虑 到 
实际 的 应 用 中 检测 时 间 很 短 ,例如 伺服 系统 中 的 测量 速度 用 于 反馈 控制 ,一般 应 在 0. Ols 以 
下 。 由 此 可 见 , 减 小 测量 误差 的 方法 是 采用 高 线 数 的 光电 编码 器 。 
M 法 测速 适用 于 测量 高 转速 ,因为 对 于 给 定 的 光电 编码 器 线 数 N ,测量 时 间 T 条 件 
下 ,转速 越 高 ,计数 脉冲 M, 越 大 ,误差 也 就 越 小 。 
工法 也 称 为 测 周 法 ,该 测速 方法 是 在 一 个 脉 种 周期 内 对 时 钟 信号 脉冲 进行 计数 的 方法 。 
例如 时 钟 频率 为 fi ,计数 器 记录 的 脉冲 数 为 M, ,光电 编码 器 是 N 线 的 ;每 周 输出 4N 个 
脉冲 ,那么 电动 机 每 分 钟 的 转速 为 式 (6. 2) 。 
15 f ak 
NM; (6. 2) 
为 了 减 小 误差 ,希望 尽 可 能 记录 较 多 的 脉冲 数 , 因 此 工法 测速 适用 于 低速 运行 的 场合 。 
PUR 028 个 编码 器 输出 脉冲 的 时 间 太 长 ,时钟 脉冲 数 会 超过 计数 器 最 大 计数 值 而 产生 
溢出 ; 另外 ,时 间 太 长 也 会 影响 控制 的 快速 性 。 与 M 法 测速 一 样 ,选用 线 数 较 多 的 光电 编 
码 器 可 以 提高 对 电动 机 转速 测量 的 快速 性 与 精度 。 
M/T 法 测速 是 将 M 法 和 工法 ,两 种 方法 结合 在 一 起 使 用 ,在 一 定 的 时 间 范 围 内 ,同时 
对 光电 编码 器 输出 的 脉冲 个 数 M, 和 M, 进行 计数 , 则 电动 机 每 分 钟 的 转速 为 式 (6. 3) 。 
15M, fu 
NM, 
在 实际 工作 中 ,在 固定 的 工 . 时 间 内 对 光电 编码 器 的 脉冲 计数 ,在 第 一 个 光电 编码 器 上 
升 沿 定时 器 开始 定时 ,同时 记录 光电 编码 器 和 时 钟 脉冲 数 , 定 时 器 定时 TT. 时 间 到 ,对 光电 
编码 器 的 脉冲 停止 计数 ,而 在 下 一 个 光电 编码 器 的 上 升 沿 到 来 时 ,时 钟 脉 冲 才 停止 记录 。 采 
用 M/T iE. BE RA. M 法 测速 的 高 速 优点 ,又 具有 工法 的 测速 的 低速 优点 ,能够 覆盖 较 广 的 
转速 范围 ,测量 的 精度 也 较 高 ,在 电动 机 的 控制 中 有 着 十 分 广泛 的 应 用 。 


6.3.3 eQEP 正 交 解码 模块 使 用 说 明 


TMS320F28069 的 eQEP 模块 主要 包括 以 下 几 个 功能 单元 。 
通过 GPIO MUX 寄存 器 编程 锁定 QEPA 或 者 QEPB 的 功能 。 
正 交 解码 单元 (QDU ) 。 

位 置 计数 器 和 位 置 计算 控制 单元 (PCCU ) 。 

正 交 捕获 单元 (QCAP) 。 

速度 /频率 测量 的 时 基 单 元 (CUTIME) 。 

用 于 检测 的 看 门 狗 模 块 。 


n = 


(6.1) 


n 


n 


(6. 3) 
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TMS320F28069 有 两 路 eQEP 模块 ,每 个 模块 有 4 个 引 脚 ,分 别 是 QEPA/XCLK 和 
QEPB/XDIR, 

这 4 个 引 脚 被 使 用 在 正 交 时 钟 模式 或 者 直接 计数 模式 。 

CD 正 交 时 钟 模式 : 正 交 编码 器 提供 两 路 相位 差 为 90 "的 脉冲 ,相位 关系 决定 了 电动 机 
旋转 的 方向 信息 ,脉冲 的 个 数 可 以 决定 电动 机 的 绝对 位 置信 息 。 超 前 或 者 顺 时 针 旋 转 时 ,A 
路 信号 超前 也 路 信号 ,滞后 或 者 道 时 针 旋 转 时 ,B 路 信号 超前 A 路 信号 。 正 交 编码 器 使 用 
这 两 路 输入 引 脚 可 以 产生 正 交 时 钟 和 方向 信号 。 

(2) 直接 计数 模式 : 在 直接 计数 模式 中 ,方向 和 时 钟 信号 直接 来 自 外 部 ,此 时 QEPA 51 
脚 提供 时 钟 输入 ,QEPB 引 脚 提供 方向 输入 。 

更 多 关于 TMS320F28069 的 eQEP 模块 主要 功能 单元 的 详细 说 明 ,可 以 参考 其 数据 手 
册 。 本 应 用 采用 eQEPI 和 eQEP2 模块 获取 左右 轮 编码 器 信息 。 其 中 eQEPI 的 QEPIA 
和 QEP1B 引 脚 分 别 连接 到 电动 机 编码 器 1 的 A 相 和 B 相 ,eQEP2 的 QEP2A fll QEP2B 
引 脚 分 别 连接 到 电动 机 编码 器 2 的 A 相 和 B 相 。 因 为 模块 兼容 原因 , 引 脚 的 对 应 关系 
为 : QEP1A 一 PB6 ,QEP1B 一 PB7,QEP2A 一 PA0,QEP2B 一 PA1。 本 实例 的 原理 如 图 6.18 
所 示 。 


GPIO20/EQEP | AMDXA/COMPIOUT 
GPIO21/EQEPIB/MDRA/COMP2OUT 
GPIOS4/SPISIMOA/EQEP2A/HRCAPI 
GPIOSS/SPISOMIA/EQEP2B/HRCAP2 


Header 6 Header 6 
图 6.18. eQEP 模块 原理 图 


下 面 说 明 利 用 TMS320F28069 的 eQEP 模块 是 如 何 实现 获得 电动 机 的 转向 转速 信 


qm 


的 。 
6.3.4 编码 器 信号 采集 


对 于 电动 机 的 速度 测量 ,应 用 中 采取 的 方法 是 利用 定时 器 的 中 断 功能 配合 编码 器 的 输出 
脉冲 信号 来 测量 电动 机 的 转速 。 其 测速 原理 是 在 规定 的 检测 时 间 ( 应 用 为 5ms) 内 ,通过 eQEP 
模块 的 位 置 计数 器 QPOSCNT 对 编码 器 输出 脉冲 信号 计数 进而 得 到 电动 机 的 速度 信息 。 

使 用 官方 的 eQEP 模块 得 到 电动 机 转速 信息 。 

第 一 步 , 选 择 步 长 为 0. 005s, 系统 时 钟 为 80MHz, 选 择 eQEP 对 应 的 I/O 引 脚 ,如 
图 6.19 所 示 。 
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= 


Groups BQEPIA pin usxignaent: 
Build options i 
Clocking EQEPIB pin assignment: (GRIDA) 
ADC 
cop EQEPIS pin asniunment: (Knee) 
eCANA m 
| “AP EQEP1I pin nasignment [ma -| 
crm 
2 tura pis cori: GB 
CT | EGEP28 pin assignment: (Gi a) 
| n 
SPI A . s< 
SPL 二 Mee oT 
[ — — EQEPZ! Eres 
ncm 


图 6.19  eQEP 模块 配置 


第 二 步 ,配置 如 下 信息 ,Model Header 头 文件 变量 安定 义 ,Model Source 源 文件 函数 声 
HH LJ PRSE System Outputs 输出 函数 ,如 图 6. 20 所 示 。 


图 6.20 编码 器 配置 
第 三 步 , 输 出 两 组 PWM ,配置 参考 6. 2 节 , 实 例如 图 6. 21 所 示 。 


Ir TT 


图 6.21 PWM 配置 


第 四 步 , 配 置 eQEP 模块 , 先 配置 eQEPI, Position counter mode 选择 Cd 
count; positive rotation 选择 Clockwise; 方 框 中 的 是 反 向 QEPx 的 极 性 ,这 里 不 选 ; 


Position counter 选择 Output position counter; Speed calculate 选择 Enable eQEP capture; 
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eQEP capture timer prescaler 选择 128 分 频 ; Unit position event prescaler 选择 32 分 频 ， 
其 他 参数 默认 ; eQEP2 的 配置 ,其 方法 与 eQEP1 的 配置 是 一 样 的 ,具体 配置 如 图 6. 22 


所 示 。 
| General | Position counter | Speed calculation — Compar 
ka Output position counter 
=- Maximum position counter value (074294967295): |4294967295 


[O Enable set to init value on index event 
[Enable set to init value on strobe event 


CO Enable software initialization 
qposcnt s Fa 
Position counter reset mode: (Reset on an index event. 


C Output position counter error flag 


General | Position counter | Speed cal, General | Position counter. Speed calcu 
— — LI Enab -QE! 
EM ooo owe] 


口 output capture timer 


Position counter mode: [Eee [Output capture period timer 
Positive rotation: EIEN cer capture tiser prescaler: [ERIS 


C Quadrature direction flag output port Unit position event prescaler: BC: 
L invert input QEPxA polarity C Enable and output overflow error flag 

C Winvert input QEPxB polarity 
Cinvert input QEPxI polarity 
[Invert input QEPxS polarity 
Lindex pulse gating option C Output capture timer period latehed valu 


Sample time: |0.005 口 Output position counter latched value 
图 6.22 eQEP 模块 配置 


C) Enable and output direction change error 


Capture timer and position: [Ün position co 


C Output capture timer latched value 


第 五 步 , 在 完成 上 述 配 置 ,并 完成 模型 的 搭建 后 ,检查 电动 机 接线 端 ,电动 机 驱动 模块 ， 
电源 模块 以 及 主 控 板 模块 是 否 连 接 正常 ,然后 将 模型 编译 下 载 到 主 控 板 ,然后 在 CCS 中 打开 
模型 生成 的 工程 文件 , 先 单 击 “ 编 译 ” 按 钮 & = ,再 单 击 “调试 ?按钮 老 :” ,然后 将 Encoder _ 
Left 以 及 Encoder_Right 这 两 个 变量 添加 到 Expressions 中 ,然后 单 击 “ 运 行 ” 按 钮 e 就 可 
以 看 到 各 个 变量 的 值 ,应 用 现象 及 Expressions 窗口 如 图 6.23 和 图 6. 24 所 示 。 


OLED 初始 化 QEP 初 始 化 


Duty cycle 范 围 : 20-100 Duty cyclel 范 围 : 20-100 
应 用 一 : 现象 为 右边 的 轮子 逆 时 针 旋 转 。 应 用 二 : 现象 为 左边 的 轮子 逆 时 针 旋 转 


= 


读 取 QEP1 的 计数 值 完成 右边 转速 的 读 取 读 取 QEP1 的 计数 值 完 成 左边 电动 机 转速 的 读 到 
图 6.23 模型 搭建 
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.图 6.24 ccs 变量 观察 


6.4 SIL 软件 在 环 测试 


软件 在 环 测试 的 详细 介绍 请 参考 5. 4. 2 节 的 相关 内 容 , 使 用 SIL 仿真 ,在 开发 计算 机 上 
测试 源 代码 ,关于 SIL 仿真 具体 可 参考 下 面 的 网 址 。 本 节 只 介绍 子 系统 创建 的 SIL 模块 。 
https:/ /ww2. mathworks. cn/help/ecoder/examples/software-and-processor-in-the-loop- 
sil-and-pil-simulatIOn. html # d117e12810 
第 一 步 ,MATLAB 的 当前 文件 夹 如 图 6. 25 所 示 ,创建 两 个 . slx 文件 。 
四 > . e 
|, Dem. | 
[ti Blink LED.shx | 
[À SIL. Blink LED.slx 


图 6.25 创建 .slx 文 件 


» 


第 二 步 . 打 开 Blink LED. slx, 配 置 Solver 为 定 步 长 类 型 ,离散 型 , 步 长 1s; Hardware 
Implementation 配置 如 图 6. 26 所 示 。 


图 6.26 硬件 配置 


第 三 步 , 在 All Parameters 中 输入 Create Block ,找到 对 应 的 参数 设置 ,选择 SIL ,再 选 
择 Code Generation Verification Enable portable word sizes, 如 图 6. 27 和 图 6. 28 所 示 。 


. Senuiaton Target Code coverage lor SIL oc PIL 
eL ee 
Lo - A Ez======] 
TUA. MIL pes C] Enable source tevel debugging for SIL 
aa ° ^E TACAR =, Custom Code 
Create block [si un ACE - uris 
Cette a Su oc Pn. blick for venficaton of genexnted code M——s TT 
图 6.27 选择 SIL 图 6.28 自动 代码 生成 


第 四 步 ,搭建 模型 如 图 6.29 和 图 6.30 所 示 , 单 击 “编译 下 载 ” 按 钮 h , 稍 等 片刻 会 生 
成 一 个 slx 模型 ,将 它 复制 到 SIL Blink LED. slx 中。 
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图 6.29 生成 slx 模型 图 6.30 slx 模 型 创建 
第 五 步 ,在 SIL_Blink_LED. slx 中 搭建 模型 如 图 6. 31 所 示 ,参数 配置 同 Blink_LED. slx。 


图 6.31 搭建 模型 
第 六 步 ,分别 将 Normal 和 SIL 模块 添加 信号 线 进行 数据 标记 ,如 图 6.32 所 示 。 


图 6.32 添加 信号 线 数据 标记 


第 七 步 , 添 加 两 个 Lamp ,分 别 与 两 个 信号 线 绑 定 ,信号 线 输出 为 0 的 时 候 ,Lamp 为 绿 
色 ; 输出 为 1 的 时 候 ,Lamop 为 红色 ,如 图 6.33 所 示 。 


图 6.33 颜色 配置 
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第 八 步 , 单 击 Run 运行 ,仿真 结束 ,看 见 两 个 Lamp 都 为 红色 ,如 图 6. 34 所 示 。 双 击 
Scope 查看 三 路 输入 的 曲线 ,中间 qaya 为 0, 如 图 6. 35 所 示 。 说 明 SIL 生成 代码 的 仿真 
结果 和 实际 Normal 的 仿真 结果 一 


SIL Output 


SiL Out boolean SIL, Output 


Data Type Conversiont 
Bhnk LED 


图 6.34 仿真 结果 


[E] Scope e dt sd 
Bie look View Simulation Help >. 
@- @p@ S-a- FBFE a- 


图 


b. 35 输 N 曲 线 


6.5 PIL 处 理 器 在 环 测试 


处 理 器 在 环 测试 的 详细 介绍 请 参考 5.4.3 节 的 相关 内 容 。 直 接 介绍 如 何 进行 PIL ama SUN 
在 环 测 试 的 操作 。 处 理 器 在 环 测试 使 用 TMS320F28069 的 SCIA GPIO28,GPIO?29 端口 。 
关于 DSP Æ Simulink 中 PIL 测试 可 以 查看 下 面 的 网 页 。 
https://ww2. mathworks. cn/help/supportpkg/texasinstrumentsc2000/ ug/ code-verification- 
and-validation-with pil. html?searchHighlight- PIL6G.s tid— doc. srchtitle 
这 个 例子 展示 了 如 何 使 用 德州 仪器 C2000 处 理 器 的 圣人 式 编码 器 支持 包 来 使 用 PIL 
进行 代码 验证 
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在 这 个 例子 中 ,主要 介绍 如 何 配置 一 个 Simulink 模型 来 运行 处 理 器 在 环 (PIL) 模 拟 。 
在 PIL 模拟 中 ,生成 的 代码 运行 在 TI C2000 处 理 器 上 。 将 PIL 仿真 结果 传递 给 Simulink， 
验证 仿真 结果 的 数值 等 效 性 和 代码 生成 结果 。PIL 验证 过 程 是 开发 周期 的 一 个 关键 部 分 ， 
以 确保 部 署 代码 的 行为 与 设计 相 匹配 。 I 

运行 SIL 和 PIL 仿真 有 3 种 方法 。 可 以 使 用 顶层 模型 Model 模块 ,或 从 子 系统 创建 的 
SIL 和 PIL 模块 。 

本 示例 只 介绍 使 用 子 系统 创建 PIL Block 方法 配置 用 于 代码 生成 和 验证 的 Simulink 
模型 。 i 

要 运行 此 示例 ,需要 以 下 硬件 : TI C2000 处 理 器 板 , 具 有 串 行 USB 功能 TI 控制 卡 提 供 
PÍT USB 功能 。 这 允许 从 目标 计算 机 到 主机 进行 串 行 通 信 。 在 这 个 例子 中 ,将 使 用 这 个 串 
行 连接 来 交换 从 Simulink 到 目标 的 数据 。 

如 何 使 用 TI 官方 提供 的 Launch 板子 ,有 关 如 何 配置 虚拟 COM 端口 的 详细 信息 ,请 参阅 
网 页 http://bbs. eeworld. com. cn/thread-459004-1-1. html。 请 注意 “端口 "(COM&LPT) 下 
Windows 设备 管理 器 中 显示 的 USB 串 行 端口 的 COM 端口 号 。 

提供 的 板子 不 支持 通过 USB 数据 线 与 Simulink 通信 ,需要 用 USB f£ TLL 模块 实现 ,前 
面 已 经 介绍 过 USB 转 TTL 模块 如 何 与 主 控 板 的 连接 ,此 处 不 再 著述 。 操 作 步 又 如 下 所 述 。 

第 一 步 , 首 先 在 计算 机 的 设备 管理 器 中 找到 USB 转 TTL 对 应 的 COM 端口 ,然后 在 
MATLAB 中 打开 此 模型 所 在 的 文件 路 径 ,里 面 有 一 个 Simulink 模型 。 然 后 在 MALAB 命 
令 行 窗 口 输入 如 下 命令 。 

(1) 按 上 述 方法 设置 COM 端口 ,并 将 以 下 命令 中 的 COMI 替换 为 与 主 控 板 对 应 的 正 
确 串 行 端口 。 


(2) 通过 输入 波 特 率 设 置 PIL 通信 的 波 特 率 。 


PIL 配置 如 图 6. 36 所 示 。 


图 6.36 PIL 配置 
(3) 通过 以 下 命令 启用 串 行 PIL。 
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如 图 6.37 所 示 。 


D em. igo ME EXNNILLLLIESVTUE 
[À c2000 pil block.slx | - - 
PUNÉR ct || >> setpref (' MathWorks Enbedded. ID 


E readme.txt | f > | 


| 
图 6.37 启用 串 行 PIL 


第 二 步 , 打 开 c2000 pil block. slx, 可 看 见 Controller 下 方 有 一 个 需要 连接 的 模块 ,这 
就 是 需要 将 Controller 生成 PIL 的 模块 ,如 图 6.38 所 示 。 


图 6.38 Controller 生成 PIL 模块 


第 三 步 , 首 先 在 All Parameters 中 输入 create block ,找到 对 应 的 参数 设置 ,选择 PIL, 


在 Solver 中 选择 Ode3 求解 器 为 Bogacki-Shampine, 定 步 长 为 0.01s, 选 择 在 将 程序 烧 写 到 
RAM 减少 编译 时 间 ,如 图 6. 39 所 示 。 


^ Stptwe 10 


|») See [pae (Bopecte-Shempne)] 


Opuma ation. Optimization | 

"ssa C Enabie poriabi word sites Reperi Fixed-step size (undementat sampie ime) [DOT] — 

wnten C Enable source ovel dabuggr. Comments 

Custom Code x ideniihers. Tasking and sample time options. 

= ja = = 
po Cone ye Dem 

` Vertcaton C Atow tasks to execute concumenty on target 
(a) Verification 中 参数 设置 (b) Solver 中 参数 设置 


图 6.39 创建 模块 


第 四 步 , 选 择 Controller 子 系统 并 右 击 ,在 C/C Code 中 选择 Deploy this Subsystem 
to Hardware, 如 图 6. 40 所 示 。 随 后 会 出 现 如 图 6.41 所 示 的 界面 ,然后 单 击 Build 按钮 , 稍 


图 6.40 部 署 到 硬件 
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等 片刻 可 以 看 见 出 现 了 一 个 新 的 模块 ,并 且 在 MATLAB 的 当前 文件 夹 中 生成 了 一 个 
Controller_pbs. mexw64 代码 文件 ,如 图 6.42 所 示 。 


Í *à Build code for Subsystem:Controller - D 
Pick tunable parameters 一 
f Varjabie Name i Class i Staráge Class i 
L= Variabi Xi n — Storage Class cri 
| - A 
+ | |! 
i 
— A 
| i 
f —— - —t L 
R Í | 
. z D E 


Blocks using selected vanable L Ya massa z X " — 
i E | Parent ] 


a nA MT L 22 £ — 


= F3 s RAE i| 
Ini 
er J 
Status 
|. Select tunable parameters and click Build 
图 6.41 编译 
门 m 
@ L, Controller ert rtw 
D| slprj 
[fi c2000 pil block.six 
自 M E dow pt mE _ pmi _ 
El PILES bt 4 > 
Lj readme.txt $ ing 4 @ ip L- 


Controller 


图 6.42 生成 Controller 


第 五 步 , 将 生成 的 Controller 模块 复制 到 c2000 pil. block. slx 模型 缺少 的 模块 处 ， 
Manual Switch 选择 与 上 面 的 子 系统 连接 ,然后 再 单 击 Run 按钮 , 稍 等 片刻 可 以 看 见 Scope 
会 生成 一 条 曲线 。 然 后 将 Manual Switch 开关 选择 与 下 面 的 子 系统 连接 ,可 以 看 见 Scope 
也 会 生成 一 条 曲线 ,与 之 前 Scope 和 Controller 连接 时 生成 的 曲线 相同 。 说 明代 码 到 目标 
处 理 器 上 的 运行 结果 也 能 够 和 模型 保持 一 致 ,如 图 6. 43 和 图 6. 44 Brom 


PIL Block 


singe2Goube ^ Manual 
Switch. 
O- a 1 PL 1 | 
Numerical i Sample based |1-10.000 
Difterence Controllert TD 


图 6.43 仿真 1 
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6.6 S-Function 


们 进 Noii 

。 表示 自 定义 算法 。 

。 将 现 有 外 部 代码 集成 到 Simulink 和 代码 生成 器 中 。 

。 表示 与 硬件 对 接 的 设备 驱动 程序 。 

。 8k A SK # RERE E DC TCR FCR. 

* Æ Simulink 仿真 过 程 中 验证 为 子 系统 生成 的 代码 。 

通过 SFunction 的 应 用 程序 编程 接口 (API) 可 以 非常 灵活 地 在 Simulink 环境 中 实现 
通用 算法 。 如 果 打 算 在 模型 中 将 S-Function 用 于 代码 生成 ,那么 灵活 度 可 能 会 有 所 不 同 。 
例如 ,需要 生成 代码 的 SFunction 不 能 访问 MATLAB 工作 区 。 本 节 介 绍 使 用 S-Function 
需要 注意 的 条 件 。 但 是 ,利用 本 节 介 绍 的 技巧 ,可 为 大 多 数 使 用 生成 代码 的 应 用 程序 创建 
S-Function, 

虽然 S-Function 提供 了 通用 且 灵 活 的 解决 方案 ,可 在 模型 中 实现 复杂 的 算法 ,但 基础 
API 会 在 内 存 和 计算 资源 方面 产生 一 定 的 开销 。 通 常 ,额外 增加 的 资源 开销 对 实时 快速 原 
m Aix 388 98 A F SE BF Rk A R RJ £ Pr P 3F 12 8 A 2F 85] n] FH SE 

。 通 过 使 用 代码 生成 器 附带 的 Target Language Compiler 技术 来 内 联 $SFunction ,可 最 
ea 如 果 为 现 有 的 外 部 代码 生成 S-Function, 那 么 可 以 考虑 使 
用 Legacy Code Tool 生成 SFunction 和 相关 的 TLC 文件 。 

接 下 来 的 内 容 假设 读者 已 理解 以 下 概念 。 

。 Level-2 S-Function 。 

* Target Language Compiler(TLC) 脚 本 编写 。 

。 代码 生成 器 如 何 生 成 和 编译 C/C++ 代码 。 

以 下 情形 适合 用 S-Function 来 实现 仿真 和 代码 生成 。 
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。 “我 不 关心 效率 ,我 只 想 让 我 的 算法 能 够 自动 在 Simulink 和 代码 生成 器 产品 中 

工作 。” 
~ “RE Simulink 和 代码 生成 器 产品 中 实现 一 种 高 度 优化 的 算法 , 它 看 起 来 就 像 是 
一 个 内 置 模块 ,并 且 能 生成 高 效 的 代码 。” 

。“ 我 有 很 多 人 工 代码 需要 集成 。 我 希望 高 效 地 从 Simulink 和 代码 生成 器 产品 中 调 
用 我 的 函数 。” 

下 面 通过 实例 介绍 Simulink 中 生成 S-Function 的 3 种 常用 手段 。 

C MEX S-Function 允许 在 Simuink 模型 中 调用 定制 的 C 代码 。 例 如 ,考虑 简单 的 C 

函数 doublelt. c, 它 输出 的 值 是 函数 输入 值 的 两 倍 。 


可 以 通过 以 下 方式 调用 doublelt. c 生成 S-Function。 

(1) 手写 wrapper S-Function。 

使 用 这 种 方法 ,可 以 手动 编写 一 个 新 的 C、S-Function 和 相关 的 TLC 文件 ,这 种 方法 需 
要 对 C, S-Function 的 结构 有 更 多 的 了 解 。 

(2) 使 用 S-Function Builder 块 。 

使 用 此 方法 ,可 以 将 S-Function 的 特征 输入 到 块 对 话 框 中 ,这 种 方法 不 需要 任何 有 关 
编写 S-Function 的 知识 。 但 是 ,对 S-Function 结构 的 基本 理解 可 以 使 S-Function Builder 
对 话 框 更 易于 使 用 。 

(3) 使 用 代码 继承 工具 (Legacy Code Tool), 

使 用 此 命令 行 方法 ,在 MATLAB 工作 区 的 数据 结构 中 定义 S-Function 的 特征 。 这 种 
方法 所 需 的 S-Function 知识 最 少 。 

还 可 以 使 用 MATLAB Function 块 从 Simulink 模型 调用 外 部 C 代码 。 更 多 信息 请 见 
Integrate C Code Using the MATLAB Function Block, 

下 面 将 描述 如 何 使 用 前 面 的 3 种 方法 创建 S-Function, 以 便 使 用 Simulink 仿真 和 使 用 
Simulink Coder 生成 代码 。 

模型 modelsfcndemo choosing sfun 包含 使 用 这 些 S-Function 的 块 。 如 果 计 划 逐 步 查 
看 示例 ,那么 请 将 此 模型 以 及 docroot/toolbox/simulink/sfg/examples 示例 文件 夹 中 的 文 
TF doublelt. c 和 doubleIt. h 复制 到 工作 文件 夹 中 。 


6.6.1 使 用 手写 S-Function 合并 定制 代码 


S-Function wrapsfcn. c 在 其 mdlOutputs 方法 调用 legacy code: doublelt. c。 如 果 计 划 
编译 SFunction 以 在 示例 模型 sfcndemo_choosing_sfun 中 运行 ,请 将 wrapsfen. c 文件 保存 
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到 工作 文件 夹 中 。 
要 将 legacy code 合并 到 S-Function 中 ,需要 在 wrapsfcn. c 开头 对 doublelt. c 进行 声 
明 。 声 明代 码 如 下 所 示 : 


具体 情况 如 图 6. 45 所 示 。 


图 6.45 SFunction 函数 配置 及 声明 


一 旦 声明 ,S-Function 就 可 以 在 其 mdlOutput method 中 使 用 doublelt. c, 如 下 所 示 。 


ddl n 


要 编译 wrapsfcn. c SFunction ,请 运行 如 下 mex 命令 ， 确保 doubleIt. c 文件 在 工作 文 
件 夹 中 。 


要 使 用 Simulink Coder 代码 生成 器 为 S-Function 生成 代码 ,需要 编写 一 个 目标 语言 编 
译 器 (TLC) 文 件 。 下 面 的 TLC 文件 wrapsfen. tlc 使 用 BlockTypeSetup 函数 为 doublelIt. c 
声明 一 个 函数 原型 。TLC 文件 的 输出 函数 会 告诉 Simulink 代码 生成 器 如 何 内 联 对 
doublelt. c 的 调用 ,如 下 所 示 。 
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有 关 TLC 的 更 多 信息 ,请 参见 Target Language Compiler Basics(Simulink Coder) 。 


6.6.2 ”使 用 S-Function Builder 模块 合并 定制 代码 


S-Function Builder 自动 创建 包含 legacy code 的 S-Function 和 TLC 文件。 在 本 例 中 ， 
除了 doubleIt. c 之 外 ,还 需要 头 文件 doublelt, h 声明 doublelt. c 函数 格式 ,如 下 所 示 。 


sfendemo choosing. sfun 中 的 S-Function Builder 显示 如 何 配 置 块 对 话 框 以 调用 
legacy 函数 doublelt. c. 

在 S-Function Builder 对 话 框 中 进行 如 下 操作 。 

第 一 步 , 在 S-Function name 中 输入 S-Function 的 名 称 builder_wrapsfcn, S-Function 
parameters 选项 区 域 列 出 了 S-Function Builder 所 包含 的 参数 。Name/Data type 的 设置 将 
在 数据 属性 页 面 中 介绍 , Value 标签 用 来 指定 对 应 的 参数 ,用 户 可 根据 需要 在 此 标签 填 人 
MATLAB 表达 式 , 执 行 完 下 面 的 操作 后 , 单 击 Build 按钮 即 可 生成 C 代码 与 可 执行 的 
MAX 文件 ,如 图 6. 46 所 示 。 
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”图 6.46 S-Function 函数 命名 
第 二 步 ,该 示例 跳 过 初始 化 页 面 的 操作 ,在 数据 属性 (Data Properties) 页 面 指定 输入 
(input) 和 输出 (output) 端 口 的 名 称 分 别 为 inl 和 outl ,如 图 6.47 所 示 。 


图 6.47 指定 输入 输出 端口 


库 文件 (Libraries) 页 面 : 提供 定制 代码 的 接口 ,用 户 可 以 在 这 里 指定 外 部 代码 文件 的 
名 称 和 位 置 ,外 部 代码 是 指 在 其 他 页 面 输入 的 定制 代码 中 引用 到 的 代码 文件 。 

(1) Library/Object/Source files 模板 用 于 声明 在 其 他 页 面 输入 的 定制 代码 中 引用 到 的 
尾部 库 文件 ,对 象 代码 以 及 源 文件 ,这 里 添加 名 为 doublelt. c 的 文件 。 如 果 代 码 文件 处 在 当 
前 工作 文件 夹 下 , 则 用 户 只 需 声 明文 件 名 即 可 ; 如 果 代 码 文 件 处 在 其 他 的 目录 下 , 则 用 户 需 
要 输入 完整 的 路 径 。 

(2) Includes 模板 该 模板 用 于 声明 头 文件 ,而 这 些 头 文件 又 声明 了 用 户 在 其 他 页 面 输 
入 的 定制 代码 中 引用 到 的 函数 。 变 量 以 及 宏 定 义 。 每 个 头 文 件 声明 占用 一 行 ,前 缀 为 
#include。 对 于 标准 C 头 文件 ,需要 用 尖 括 号 将 文件 名 括 起 来 ,如 #include< math. h >; 对 
于 用 户 自 定义 的 头 文件 , 则 需要 用 半角 双 引 号 件 文件 名 括 起 来 ,如 #include"xx.h"; 如 果 用 
户 引用 的 头 文件 不 处 在 当前 工作 目录 下 , 则 需要 在 前 述 Library/Object/Source files 模板 
中 ,前 级 为 INC_PATH ,指定 该 头 文件 的 目录 。 | 

该 示例 使 用 以 下 字段 ,用 来 包含 声明 定制 函数 的 头 文件 。 


L dens 


具体 配置 如 图 6. 48 所 示 。 
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图 6.48 ” 库 文件 (Libraries) 配 置 


(1) Outputs 输出 页 面 。 
S-Function Builder 在 mdlOutputs 回调 方法 中 加 入 了 一 条 调用 这 个 wraper 函数 的 代码 。 


具体 配置 如 图 6. 49 所 示 。 


*outl = doublelt(*inD; 


图 6.49 Output 输出 界面 


(2) Build Info 编译 信息 页 面 选 择 Generate wrapper TLC, 如 图 6. 50 所 示 。 


Waq me TI 
图 6.50 Build Info 编译 信息 页 面 
当 完 成 以 上 操作 后 , 单 击 Build 按钮 ,S-Function Builder 会 生成 3 个 文件 ,如 表 6.3 所 示 。 
表 6.3  S-Function Builder 生成 文件 及 介绍 


X 4E Jj0)a $ 
builder wrapsfen. c 主要 S-Function kal 
builder. wrapsfcn, wrapper. c 包含 S-FunctionBuilder 的 输出 、 连 续 导 数 和 离散 更 新 窗 格 中 输入 的 
代码 的 独立 函数 的 包装 文件 


builder wrapsfen. tle S-Function 的 TLC 文件 
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builder wrapsfcn. c 文件 采用 标准 格式 。 
该 文件 以 一 组 # define 语句 开始 ,这 些 语句 包含 来 自 S-Function Builder 的 信息 。 例 
如 ,下 面 的 代码 定义 了 第 一 个 输入 端 。 


(1) 接 下 来 ,该 文件 声明 了 在 builder wrapsfen wrapper. c 文件 中 找到 的 所 有 wrapper 
函数 。 此 示例 只 需要 输出 代码 的 wrapper 函数 。 

(2) 在 这 些 定义 和 声明 之 后 ,文件 包含 S-Function 方法 ,如 mdlInitializeSize, 它 们 初始 
化 S-Function 的 输入 端口 .输出 端口 和 参数 。 有 关 在 S-Function 初始 化 阶段 调用 的 方法 的 
列表 ,请 参见 Process View, 

(3) 该 文件 的 mdlOutputs 方法 调用 builder wrapsfen wrapper. c 函数 ,在 利用 该 方法 


在 调用 wrapper 函数 时 使 用 数据 属性 窗 格 (Data Properties pane) 中 定义 的 1 和 out 1 中 的 
输入 和 输出 名 称 ,示例 如下。 


(4) 文件 builder wrapsfen. c 需要 以 mdlTerminate 方式 结束 。 
(5) wrapper K% builder_ wrapsfcn_wrapper.c 有 3 个 部 分 。 
(6) Include Files 部 分 包括 doublelt. h 文件 以 及 标准 的 S-Function 头 文件 。 
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(7) 外 部 引用 部 分 包含 信息 来 自 Libraries 页 面 的 External reference declarations, 此 示 
例 不 使 用 此 部 分 。 

(8) Output functions 部 分 声明 函数 builder_wrapfcn_Outputs_wrapper, 其 中 包含 在 
S-Function Builder 块 的 Outputs 窗 格 中 输入 的 代码 。 


注意 : 与 手写 的 SFunction 相 比 ,S-Function 生成 器 通过 包装 文件 builder_wrapsfcn 
wrapper. c. 将 对 Legacy 函数 的 调用 降低 了 一 个 优先 级 。 

(9) 由 S-Function Builder 生成 的 TLC 文件 builder_wrapsfcn. tlc 与 以 前 的 手写 版 本 
类 似 。 该 文件 在 BlockTypeSetup 中 声明 legacy 函数 ,并 在 Output 中 调用 它 。 
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6.6.3 使 用 代码 继承 工具 合并 定制 代码 


本 节 将 C 函数 集成 到 Simulink 模型 中 ,并 在 “Writing S-Functions in C” 中 显示 如 何 使 
用 Legacy 代码 工具 来 创建 包含 doublelt. c 的 S-Function。 对 于 执行 该 示例 中 的 步骤 的 脚 
本 ,请 将 lct_wrapsfcn. m 文件 复制 到 工作 文件 夹 中 。 确保 doublelt. c 和 doubleIt. h 文件 位 
于 工作 文件 夹 中 ,然后 在 MATLAB 命令 提示 符 下 键入 let_wrapsfcn 运行 脚本 ,或 者 双击 打 
JF lct_wrapsfen. m, 然 后 在 编辑 器 工具 栏 下 方 单 击 Run 按钮 。 脚 本 通过 以 下 命令 创建 和 纺 
VÉ S-Function legacy_wrapsfen. c, 并 创建 TLC 文件 Legal. Wrapsfcn. tle, 
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Legacy Code 工具 生成 的 S-Function legacy_wrafenc 首先 包括 doublelt. h 头 文件 。 然 
后 ,mdlOutpnut 方法 直接 调用 doublelt. c 函数 ,如 下 所 示 。 


由 Legacy Code 工具 生成 的 S-Function 与 S-Function Builder 生成 的 S-Function 的 区 
别 如 下 。 

(1) S-Function Builder 生成 的 S-Function 通过 wrapper r i 数 builder. wrapsfcn _ 
wrapper. c 调用 legacy 函数 doublelt. ec。 由 代码 继承 工具 生成 的 SFunction 直接 从 其 
mdlOutput 方法 调用 doublelt. c. 

(2) S-Function Builder 使 用 输入 和 输出 名 称 输入 数据 属性 窗 格 ,允许 在 S-Function 中 
自 定义 这 些 名 称 。 代 码 继承 工具 分 别 对 输出 和 输入 使 用 默认 名 称 y 和 u。 当 使 用 代码 继承 
工具 时 ,不 能 指定 在 生成 的 S-Function 中 使 用 的 自 定义 名 称 。 

(3) 默认 情况 下 ,S-Function Builder 和 代码 继承 工具 都 指定 了 继承 的 采样 时 间 。 但 
是 ,S-Function Builder 使 用 的 偏 移 时 间 为 0. 0 ,而 代码 继承 工具 指定 在 较 短 的 时 间 步 长 中 固 
定 偏 移 时 间 。 

通过 定义 BlockInstanceSetup 和 BlockOutputSignal 函数 ,TLC 文件 legacy. wrapsfen. 
tlc XX f£ expression folding, TLC 文件 还 包含 一 个 BlockTypeSetup 函数 ,用 于 声 明 
doublelt. c 的 函数 原型 ,还 有 一 个 输出 函数 ,用 于 告诉 Simulink Coder 代码 生成 器 如 何 内 联 
对 doublelt. c 的 调用 。 
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6.7 OLED12864 显示 


OLED 屏幕 作为 一 种 新 型 的 显示 技术 ,其 自身 可 以 发 光 ,亮度 、 对 比 度 高 , 功 耗 低 ,在 当 
下 备 受 追 捧 。 而 在 正常 的 显示 调整 参数 过 程 中 , 越 来 越 多 的 人 使 用 这 种 屏幕 。 使 用 的 一 般 
是 分 辩 率 为 128X64 像素 ,屏幕 尺寸 为 0.96 寸 。 由 于 其 较 小 的 尺寸 和 比较 高 的 分 辩 率 ,让 
它 有 着 很 好 的 显示 效果 和 便携 性 ,具体 参数 如 表 6.4 所 示 。 


表 6.4 OLED12864 屏幕 参数 配置 


基本 信息 : £ 数 
HRR 128X64 像素 
电压 3.3—5V 
协议 IIC/SPI 


目前 经 常 使 用 的 OLED 屏幕 一 般 有 两 种 接口 : IC 或 者 SPI, 两 者 使 用 的 通信 协议 稍 有 
不 同 , 这 里 以 SPI 协议 的 OLED 屏幕 为 例 , 介 绍 其 使 用 方法 ,其 模块 接口 定义 如 表 6.5 


所 示 o 
表 6.5 模块 接口 定义 

名 称 用 Ê TMS320F28069 引 脚 
GND 电源 地 GND 

VCC 电源 正 (3.3—5.5V) 3.3V 

SCL 在 SPI 和 IIC 通 信 中 为 时 钟 引 脚 GPIO50 

SDA JE SPI AI TIC 通信 中 为 数据 引 脚 GPIO43 

RES ` 用 来 复位 ( 低 电 平复 位 ) GPIO12 

DC 数据 和 命令 控制 引 脚 GPIO23 

具体 使 用 方法 如 下 : 


一 般 OLED 屏幕 都 会 有 一 套 相 配套 的 程序 库 , OLED 屏幕 接口 引 脚 的 定义 如 图 6. 51 
所 示 。 对 接口 引 脚 进行 了 一 次 统一 的 定义 ,从 而 提高 了 程序 的 可 移植 性 。 


fe OLEDRQE ---------------- H 
Sdefine OLED SCLK Clr() (GpioDətaRegs.GPBCLEAR.bit.GPIOS@=1) //SCL,DO GPIOSe 
"define OLED SCLK Set() (GpioDataRegs.GPBSET.bit.GPIO50-1) //SCL,DO 

"define OLED SDIN Clr() (GpioDataRegs.GPBCLEAR.bit.GPIO43-1)  //SDA,DI GPIO43 


fdefine OLED RST Clr()  (GpioDataRegs.GPACLEAR.bit.GPIO12-1) //RST GP1012 


RST ; Gp: 
#define OLED_RS_Clr() (GpioDataRegs.GPACLEAR.bit.GPIO23-1) //DC GP1023 


"define OLED RS Set() (GpioDataRegs.GPASET.bit.GPIO23-1) //DC 


图 6.51 接口 引 脚 相 关 定 义 


还 需要 在 Initial OLED() 函 数 中 加 入 对 1/0 口 初始 化 以 及 端口 时 钟 初始 化 的 相关 代 
码 ,配置 为 自己 将 要 使 用 的 IO H ,因为 采用 的 是 模拟 SPIL X L/O 口 并 没有 太 多 的 要 求 ,只 
要 不 与 其 他 L/O 口 使 用 复 用 即 可 。 
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在 TMS320F28069 中 ,对 1/O 口 、 输 出 模式 ,端口 时 钟 等 进行 配置 ,如 图 6.52 所 示 。 


void OLED_Init(void) 
t 


EALLOW; 

GpioCtrlRegs.GPBMUX2.bit.GPIOS0-0;  //SCL 对 及 DO 
GpioCtrlRegs.GPBMUX1.bit.GPIO43-0;  //SDAsT:DI 
GpioCtrlRegs.GPAMUX1.bit.GPIO12-0;  //RES 对 应 RST 
GpioCtriRegs.GPAMUX2.bit.GPIO23-0;  //DC» DC 
GpioCtrlRegs.GPBDIR.bit.GPIO5e -1; //SCL 
GpioCtrlRegs.GPBDIR.bit.GPIO43 -1; //SDA 
GpioCtrlRegs.GPADIR.bit.GPIO12 -1; //RES 
GpioCtrlRegs.GPADIR.bit.GPIO23 -1; //0C 
EDIS; 

GpioDataRegs.GPASET.bit.GPIO23-1; 
GpioDataRegs.GPBSET.bit.GPIO43-1; 
GpioDataRegs.GPASET.bit. GP101221; 
GpioDataRegs.GPBSET.bit.GPIOSe-1; 


OLED. RST. C1r(); 
DELAY, US(10000) ; 
OLED, RST. Set(); 


E 6.52 1/O 口 配置 相关 程序 


之 后 是 硬件 接线 ,SPI 协议 的 屏幕 有 7 根 线 , 其 中 包括 2 根 电 源 线 ,另外 5 根 线 则 需要 
和 程序 定义 的 SPI 端口 一 一 对 应 ,连接 到 单片机 或 者 树 莓 派 等 设备 上 。 完 成 以 上 工作 之 后 ， 
就 可 以 调用 相关 函数 进行 显示 了 。 

这 里 已 经 将 OLED12864 的 相关 函数 通过 代码 继承 工具 封装 成 SFunction, 只 需 在 
Simulink 中 调用 相关 模块 即 可 实现 液晶 显示 数据 的 功能 。 

这 里 以 显示 字符 型 . 浮 点 型 .整数 型 数据 为 例 , 来 演示 如 何 通过 封装 好 的 模块 来 显示 对 
应 的 数据 。 


实例 目标 


第 一 行 显示 : AnHui Hopemotion; 第 二 行 显示 ; Balance Car; 第 三 行 显示 : 56.62; 第 
四 行 显示 : 120, 


操作 过 程 
第 一 步 ,新 建 模型 ,完成 系统 时 钟 , 步 长 为 0.005s 等 相关 参数 的 配置 。 
第 二 步 , 从 外 设 驱 动工 具 箱 选择 初始 化 函数 模块 Initial_OLED 完成 1/O 的 初始 化 , 然 


后 在 主 函数 的 While 循环 中 完成 液晶 的 显示 ,最 后 通过 两 个 LED 灯 的 亮 灭 验证 程序 是 否 在 
正常 运行 ,模型 搭建 如 图 6.53 一 图 6.55 Bron. 

每 个 模块 都 有 详细 说 明 ,双击 即 可 查看 ,此 处 不 再 著述 。 左 边 的 display_string_8 X 16 
模块 将 X Y 的 参数 都 设 为 1(X 表示 可 以 显示 1.3.5.7 行 的 内 容 ,Y 表示 可 以 显示 1— 120 
列 的 内 容 ); 右边 的 display_string_8X16 模块 将 X. Y 的 参数 分 别 设 为 3,24; OLED_show_ 
float 模块 将 X, Y 的 参数 分 别 设 为 5.24,Len( 数 据 长 度 ) 为 4,Dot( 小 数 点 位 数 ) 为 2, 这 里 为 
了 验证 能 否 输出 为 56. 62; OLED_show_numbe 模块 将 X, Y 的 参数 分 别 设 为 7.24,Len( 数 
据 长 度 ) 为 3。 
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Ë Simulink Library Browser - 口 x 
< = [Enter search term Ja- 8) s m; = @ 

HM 

DSP28069/Oled Driver 28069 


> Computer Vision Toolbox 
» Control System Toolbox 
Data Acquisition Toolbox 
> Deep Learning Toolbox 
| > DSP System Toolbox 
? DSP System Toolbox HDL Support 
|| > Embedded Coder 


| » Embedded Coder Support Package for Tex 
[> Fixed-Point Designer - 
| 


L— string &x16 T | 


ECAP | Driver. 28069 
Infrared Driver 28069. 
KEY Driver 28069 


die 


er « 
SCIA Driver 28069 
Variable set 


Variable string 
Image Acquisition Toolbox 
Instrument Control Toolbox 
x 


图 6.53 Library 库 文件 
初始 化 OLED 


m 


累加 计数 与 常 值 比 较 


GPIO25 


ERE While 
在 主 函 数 完成 液晶 显示 
图 6.54 模型 搭建 


DET: 


, display string. 8x1 
显示 字符 型 数据 显示 字符 型 数据 


显示 浮 点 型 数据 显示 整数 型 数据 
图 6.55 显示 数据 类 型 
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在 这 里 一 定 要 注意 数据 的 数据 类 型 ,不然 在 编译 模型 的 时 候 会 报错 ,其 中 , text 输入 
可 以 通过 Constant 模块 给 定 ,abs('T') 代 表 将 字符 转换 为 ASCII 值 ,外 设 工具 箱 已 经 将 字 
符 变 量 集成 到 Variable string 中 ,只 需 直 接 调 用 即 可 ,如 图 6. 56 所 示 。YY 的 值 根 据 字 符 长 
度 设置 ,每 个 字符 占 8 列 , 总 共 128 列 。 
在 完成 上 述 配置 ,并 完成 模型 的 搭建 后 ,将 液晶 显示 模块 插 在 主 控 板 上 ,然后 将 模型 编 
译 下 载 到 主 控 板 , 观 察 OLED 是 否 能 够 正常 显示 想 要 的 数据 。 模 型 烧 写 到 DSP 中 显示 的 
结果 如 图 6.57 Bro. 
V HM 
DSP28069 
28069 Common blocks 
ADC Driver 28069 
Commonly used bolcks 
ECAP Driver 28069 
Infrared Driver 28069 
KEY Driver 28069 
MPU6050 Driver 28069 
Oled Driver 28069 


QEP Driver 28069 wi eol 
SCIA Driver 28069 

Variable set 

Variable string EO 


图 6.56 Variable string 中 字符 变量 图 6.57 运行 结果 


6.8 MPU6050 数据 读 取 


回 Ly! L 
为 了 完成 平衡 移动 机 器 人 的 直立 控制 ,需要 测量 平衡 移动 机 器 人 的 倾角 和 角速度 。 视频 讲解 
InvenSense 公司 推出 的 MPU6050 集成 了 三 轴 加 速度 计 , 可 以 通过 IIC 接口 同时 输出 3 个 
方向 上 的 加 速度 信号 ,同时 ,MPU6050 中 也 集成 了 三 轴 陀 螺 仪 ,可 以 同时 输出 3 个 方向 的 
陀螺 仪 信号 ,MPU6050 内 部 也 置信 了 一 个 温度 传感器 。MPU6050 是 全 球 首 例 九 轴 和 运动 处 
理 传 感 器 。 它 集成 了 二 轴 MEMS 陀螺 仪 ,二 轴 MEMS 加 速度 计 , 以 及 一 个 可 扩展 的 数字 运 
动 处 理 器 (Digital Motion Processor, DMP) ,可 用 IIC 接口 连接 一 个 第 三 方 的 数字 传感器 ， 
比如 磁力 计 。 扩 展 之 后 就 可 以 通过 其 HC 或 SPI 接口 输 
出 一 个 九 轴 的 信号 (SPI 接口 仅 在 MPU6000 可 用 )。 
MPU6050 也 可 以 通过 其 IIC 接口 连接 非 惯 性 的 数字 传 
感 器 ,比如 压力 传感器 。 
本 实例 利用 TMS320F28069 的 IIC 模块 ,通过 配置 
其 相关 寄存 器 实现 与 MPU6050 的 通信 ,获取 陀螺 仪 的 温 
度 ,MPU6050 模块 如 图 6. 58 所 示 , 左 图 为 正面 图 , 右 图 
为 反面 图 。 图 6.58 MPU6050 模块 正面 图 


B 反面 医 
MPU6050 模块 引 脚 说 明 如 表 6.6 所 示 。 gx 
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表 6.6 MPU6050 模块 引 脚 说 明 


引 脚 名 称 说 明 TMS320F28069 

“VEC ! 3.3 一 5V( 内 部 有 稳 压 芯片 ) 5V 
GND 地 线 , GND 

SCL MPU6050 作为 从 机 的 TIC 时 钟 线 SCLA 
SDA MPU6050 作为 从 机 的 IC 数据 线 SDAA 
Xt. MPU6050 作为 主机 的 TIC 时 钟 线 

XDA MPU6050 作为 主机 的 IC 数据 线 

ADO 地 址 引 脚 ,该 引 脚 决定 了 IC 地址 的 最 低位 GND 

INT 中 断 


这 里 重点 讲解 ADO 的 作用 ,在 TIC 通信 中 从 机 是 要 有 地 址 的 ,以 区 别 多 个 从 机 。 当 
ADO 引 脚 接 低 电 平 的 时 候 , 从 机 地 址 是 0xD0。 从 MPU6050 的 寄存 器 中 可 以 得 到 数据 ， 
当 MPU6050 作为 一 个 IC 从 机 设备 的 时 候 , 有 8 位 地 址 ,高 7 位 的 地 址 是 固定 的 ,就 是 
WHOAMI 寄存 器 的 默认 地 址 0x68 ,最 低 的 一 位 是 由 ADO 的 连 线 决定 的 。 

在 读 取 原 始 数 据 这 个 过 程 中 ,一 个 很 重要 的 思路 就 是 一 步 一 步 进 行 , 确 保 每 步 都 对 ,之 
后 就 很 容易 读 出 正确 的 数据 。 对 MPU6050 进行 读 写 传感器 数据 就 是 对 MPU6050 的 寄存 
器 用 IIC 进行 读 写 。 还 应 了 解 MPU6050 的 寄存 器 ,这 个 过 程 与 单片机 的 学 习 没 有 什么 区 
别 , 重 点 也 是 配置 寄存 器 , 读 取 数据 。 通 过 查阅 其 数据 手册 可 知 , 对 MPU6050 的 初始 化 只 
需要 对 MPU6050 的 0x6B.0x6A.0x37.0x1A.0x1B 和 0xlC 寄存 器 通过 IIC 通信 修改 其 数 
据 即 可 完成 配置 。 

* 0x6B: 该 寄存 器 允许 用 户 配 置 电 源 模式 和 时 钟 源 , 一 般配 置 为 0x00 即 可 。 
0x6A: 用 户 配置 寄存 器 。 

。0x37: INT 引 脚 配置 寄存 器 。 

OxlA; 该 寄存 器 有 两 个 功能 ,本 程序 只 配置 了 数字 低 通 滤波 器 。 
0x1B: 这 里 设置 了 陀螺 仪 的 量程 为 士 2000"/s。 

OxlC; 本 程序 只 是 选择 加 速度 计量 程 士 4g。 

MPU6050 与 控制 板 的 连接 图 如 图 6. 59 所 示 。 

下 面 介 绍 陀螺 仪 与 加 速度 计 。 

1) 陀螺 仪 

陀螺 仪 相关 参数 如 图 6. 60 所 示 。 

陀螺 仪 的 范围 有 士 250、 士 500, 士 1000、 士 2000 可 选 ,而 对 应 的 精度 分 别 是 131LSB/C/s). 
65. 5LSB/(°/s) .32, 8LSB/(°/s) \16., 4LSB/C/s). 

(1) 这 个 精度 和 范围 的 关系 是 什么 ? 

首先 MPU6050 数据 寄存 器 是 一 个 16 位 的 ,由 于 最 高 位 是 符号 位 , 故 数据 寄存 器 的 输 
H 35 E] Ji — 7FFF —7FFF ,也 是 一 32767 一 32767 , 

(2) 如 果 选 择 陀螺 仪 范围 是 士 2000, 那 么 意味 着 一 32767 对 应 的 是 一 2000(/s),32767 
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MPU6050 
Be Ze E GPIO32/SDAA/EPWMS YNCI/ADCSOCAO 
GPIO33/SCLA/EPWMSYNCO/ADCSOCBO 


GPIO34/COMP20UT/COMP3OUT 
图 6. 59 MPU6050 与 控制 板 的 连接 图 


2 
2 


655 
328 
164 
:2 
a2 


图 6.60 陀螺 仪 相 关 参 数 (数据 手册 截图 ) 


对 应 的 是 2000 C /s) , 当 读 取 陀 螺 仪 的 值 是 1000 的 ;对 应 的 角速度 计算 如 下 : 32767/2000— 
1000/r; B] x = 1000/16. 4 (*/s) , 可 以 看 出 ,3276772000 = 16.4, 对 应 手册 中 的 精度 
16. 4LSB/ C /s) ,其 他 范围 的 也 是 如 此 。 

(3) 在 四 轴 姿 态 计算 中 ,通常 要 把 角度 换算 成 弧度 。 转 换 公 式 如 式 (6.4) 所 示 。 

2Pi/360 = (2 X 3. 1415926)/360 =0.0174532 — 1/57. 30 (6. 4) 

(4) 总 结 : 当量 程 范围 为 一 2000 一 十 2000, 把 陀螺 仪 获取 的 数据 转换 为 真正 的 弧度 每 
秒 的 公式 (gyro_x 来 代表 从 陀螺 仪 读 到 的 数据 ): gyro, x/ (16. 40 x 57.30)= gyro_x * 
0. 001064 ,单位 为 弧度 每 秒 。 | 

2) 加 速度 计 

加 速度 计 相 关 参 数 如 图 6. 61 所 示 。 

采用 和 陀螺 仪 同样 的 计算 方法 , 当 AFS_SEL=3 时 ,数字 一 32767 XE — 16g ,32767 对 
应 16g 。 把 32767 除 以 16, 就 可 以 得 到 2048 ,所 得 数值 对 应 加 速度 计 的 灵敏 度 大 小 。 把 从 
加 速度 计 读 出 的 数字 除 以 2048 ,就 可 以 换算 成 加 速度 的 数值 。 举 个 例子 ,如 果 从 加 速度 计 
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读 到 的 数字 是 1000 ,那么 对 应 的 加 速度 数据 是 1000/2048—0. 49g 。g 为 加 速度 的 单位 , 重 
力 加 速度 定义 为 1g ,等 于 9. 8m’/s。 

更 多 关于 MPU6050 数据 的 获取 以 及 滤波 算法 请 查阅 如 下 链接 : 

https://blog. csdn. net/qq_29350001/article/category/7303760 

在 对 MPU6050 操作 之 前 首先 要 初始 化 TMS320F28069 的 IIC 功能 引 脚 ,本 实例 选取 
GPIO32 和 GPIO33 分 别 作 为 TIC 模块 的 SDA 功能 引 脚 和 SCL 功能 引 脚 。 


通过 查阅 其 数据 手册 可 知 ,对 于 MPU6050 的 初始 化 只 需要 对 MPU6050 的 0x6B、 
Ox6A.0x37.0x1A.0x1B 和 0xlC 寄存 器 通过 IC 通信 修改 其 数据 即 可 完成 配置 。 


Ee SPAA RSA te 7 2 XX y : b rg "ros 
7 2 Web A 
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NETS TN 


基于 前 面 的 函数 ,本 实例 对 于 读 取 MPU6050 数据 也 封装 了 一 个 函数 。 


k Bras - 


OF TO a n 


通过 调用 ReadData() 函 数 并 给 出 相应 的 参数 , 便 可 以 得 到 MPU6050 的 原始 数据 。 然 


后 通过 Get_Angle() 进 行 对 MPU6050 的 原始 数据 进行 处 理 ,函数 如 下 。 


- — WA 
EY yum AF 
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注意 : 理想 情况 下 ,只 需 测量 其 中 一 个 方向 上 的 加 速度 值 , 就 可 以 计算 出 平衡 移动 机 器 
人 的 倾角 。 比 如 使 用 Y 轴 或 者 X 轴 。 平 衡 移动 机 器 人 静止 的 时 候 , 只 存在 重力 加 速度 , 没 
有 运动 加 速度 ,此 时 X 轴 和 YY 轴 都 输出 零 。 当 平衡 移动 机 器 人 有 一 定 的 倾角 之 后 ,会 在 义 
Ah X, Y 轴 有 重力 加 迷 度 分 量 , 而 且 该 轴 倾斜 的 角度 和 重力 分 量 的 大 小 相关 。 因 为 使 用 的 是 
三 轴 的 加 速度 计 ,所 以 可 以 使 用 atan2(yy*x) 函 数 进行 更 科学 的 计算 。 


Angley =atan2(Accely ,Accelz ) X (6.5) 


Anglex — atan2 (Accely ,Accelz ) X p (6. 6) 


atan2(y,x) 是 表示 X-Y 平面 上 所 对 应 的 (z,y) 坐 标的 角度 ,返回 的 是 原点 到 点 (zyy) 
的 方位 角 , 即 与 坐标 系 的 X 轴 的 夹 角 , 它 的 值 域 范围 是 (一 Pi, Pi), 也 就 输出 值 要 通过 
180/PI 转化 为 角度 。 

由 于 使 用 陀螺 仪 积 分 得 到 的 角度 因为 自身 的 零点 漂移 ,误差 随 着 时 间 变 化 逐步 增 大 , 误 
差 越 来 越 大 。 加 速度 计 测 量 的 角度 信号 在 受 外 界 干 扰 的 情况 下 ,也 会 很 不 稳定 。 而 通过 柄 
合算 法 一 阶 滤波 或 者 更 为 复杂 的 卡尔 曼 滤 波 得 到 的 角度 值 则 很 稳定 ,这 里 选择 卡尔 曼 滤波 
算法 。 
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如 果 想 了 解 更 多 TMS320F28069 的 IIC 原理 及 应 用 ,请 参考 其 相关 数据 手册 ,同样 如 
果 想 知道 更 多 关于 MPU6050 的 知识 ,请 参考 其 DataSheet ,里 面 会 有 详细 说 明 。 为 了 方便 
快速 实现 控制 算法 的 验证 ,将 上 述 函 数 都 封装 为 SFunction 模块 ,如 图 6. 62 所 示 。 


图 6.62 MPU6050_Driver 28069 函数 模块 封装 


这 里 想 要 将 MPU6050_Get_Angle 模块 得 到 的 平衡 角度 值 在 OLED 上 显示 ,执行 如 下 
操作 即 可 实现 。 

第 一 步 , 完 成 系统 时 钟 等 相关 配置 。 

第 二 步 ,首先 完成 初始 化 函数 的 搭建 ,然后 将 MPU6050 的 数据 读 取出 来 以 及 将 角度 值 
提取 到 存储 模块 中 ,通过 LED1 灯 的 亮 灭 来 验证 模式 有 没有 烧 写 到 主 控 板 中 ,然后 将 读 取 的 
角度 值 通过 OLED 模块 实现 数据 显示 o 

注意 : 因为 角度 值 有 正 有 负 , 所 以 加 了 一 个 正 负 条 件 判 断 , 特 别 要 注意 数据 类 型 应 一 
致 ,部 分 模型 搭建 如 图 6.63 所 示 。 

第 三 步 , 通 过 以 上 步 又 完成 整个 模型 搭建 ,如 图 6. 64 所 示 。 

第 四 步 ,将 模型 烧 写 到 主 控 板 ,将 液晶 显示 模块 插 在 主 控 板 上 ， NUETTNE. 往 前 
倾 . 往 后 倾 ,查看 OLED 显示 的 数据 ,分 别 如 图 6.65 所 示 。 
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display string 8x16-1 splay string 8x16-2 
显示 " AnHui Hopemotion" 字 符 型 数据 显示 ” pem Car" 字 符 型 数据 


= | 


display string 8x16-3 
车 身 角 度 值 显示 车 身 角 度 值 整数 型 数据 显示 "Angle" 字 符 型 数据 


图 6.63 显示 平衡 角度 值 的 部 分 模型 搭建 


a ere pem 


LEDJA KK 


读 取 MOU6050 数 据 


图 6.64 整体 模型 的 搭建 


(a) 平衡 放置 (b) 往 前 倾 (c) 往 后 倾 
图 6.65 数据 显示 结果 
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6.9 ADC 电压 采集 


本 实例 使 用 电阻 分 压 的 方式 对 电池 电压 进行 测量 ,根据 经 验 ,一 般 航 模 电池 的 电量 是 和 
电压 相关 的 ,例如 , 满 电 的 时 候 是 12. 6V, 过 放 ( 电 压低 于 9. 6V) 必 然 导 致电 池 永 久 过 放 , 所 
以 有 必要 通过 监控 电池 电压 的 变化 ,近似 表示 电池 的 电量 ,在 电池 电量 比较 低 的 情况 下 , 提 
醒 充 电 , 电 压 检测 模块 的 原理 图 如 图 6. 66 所 示 。 


ADCINA2/COMPIA/AIO2 
ADCINA3 
ADCINA4/COMP2A/AIO4 
ADCINA5 
ADCINA6/COMP3A/AIO6 
ADCINA7 


ADC 
> 
g 
Q 
Z 
= 


ADCINB2/COMP1B/AIO10 
图 6.66 电压 检测 模块 的 原理 图 


简单 分 析 可 知 ,电池 电压 经 过 电阻 分 压 , 衰 竭 为 原来 的 1/11 之 后 , 送 至 单片机 ADC 检 
测 , 以 12 ft ADC fj TMS320F28069 举例 ,temp 为 ADC 采集 的 变量 ,那么 很 容易 计算 得 到 
电池 的 电量 : 

Volt — temp X 3. 3 X 11/4096( V) (6. 7) 

XT ADC 的 介绍 前 面 已 经 介绍 过 了 ,为 了 简便 已 将 电压 检测 封装 成 S- Function, R 
直接 将 电压 值 读 取出 来 即 可 。 下 面 通过 具体 实例 操作 来 演示 如 何 通 过 Simulink 搭建 读 取 
电池 电压 值 的 模型 。 

第 一 步 ,完成 系统 时 钟 等 相关 配置 。 

第 二 步 ,从 外 设 工具 箱 找到 ADC 初始 化 函数 模块 .电压 检测 函数 模块 ,如 图 6. 67 所 示 ， 
要 想 了 解 模块 的 具体 函数 ,只 需 打 开 对 应 模型 的 help 文档 。 


MPU6050 Driver 28063 Read CCD Volitage Measure 


图 6.67 工具 箱 ADC Drive 28069 模块 


第 三 步 ,从 外 设 工 具 箱 找到 电压 数据 存储 模块 .电压 数据 写 和 模块 .电压 数据 读 取 模 块 ， 
如 图 6.68 所 示 。 
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HM 
DSP28069/Variable set 


[3 Embedded Coder Support Package for Texas in ^ 

|? Fixed-Point Designer ml 
E MCN Data Store Data Store 
> HDL Verifier » us » 


DSP21 
28069 Common blocks Data Store Data 
ADC Driver 28069 Memory8 ~ Memory9 
Commonly used bolcks 
ECAP Drier Em EM 
Infrated Driver 28069 
KEY | Data Store Data e 


mx Reado 
Image Acquisition Te Xen] 
Instrument Control Toolbox Data Store — Data Store 

> Mixed-Signal Blockset 


ite10 ` Write2 Write3 
» Model Predictive Control Toolbox 
GEL £ mmi 
» Toolbox 

OPC Toolbox Data Store — Data Store 
> Phased Array System Toolbox Weoles sen was 


图 6.68 工具 箱 Variable set 模块 


第 四 步 , 利 用 液晶 在 While 循环 显示 电压 值 ,display_string_8x16 显示 “Volt:” 字 符 型 
HUE .X—3.,Y-—24COX/Y 可 自行 设 定 ) ,OLED show. float 读 取 电压 值 ,X=3、 Y— 64, Len— 
4、Dot 二 2 ,模型 搭建 如 图 6. 69 所 示 。 


E E 


ibn" Vot: "字符 型 数据 


显示 电压 值 浮 点 型 数据 
图 6.69 电压 值 显示 模型 


第 五 步 ,完成 以 上 配置 ,搭建 模型 如 图 6.70 所 示 。 


初始 化 ADC 初始 化 OLED 存储 电压 值 


于 主 函数 OLED 显 示 电压 什 a 


图 6.70 电压 采集 模型 
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第 六 步 , 将 模型 烧 写 到 主 控 板 ,将 液晶 显示 模块 插 在 主 控 板 上 ,然后 打开 带 有 电压 检测 
电路 的 电源 板 供电 开关 ,查看 OLED 显示 的 数据 ,结果 如 图 6.71 所 示 。 


图 6.71 电压 采集 结果 


6.10 本 章 小 结 


本 章 主要 介绍 了 智能 平衡 移动 机 器 人 的 进 阶 应 用 ,包括 eCAP 超声 波 测 距 、ePWM E 
动机 调 速 、eQEP 正 交 解码 、SIL 软件 在 环 测试 .PIL 处 理 器 在 环 测试 、S-Function、 
OLED12864 显示 、MPU6050 数据 读 取 、ADC 电压 采集 以 及 相关 MATLAB/Simulink 的 搭 
建 与 仿真 实验 。 通 过 本 章 的 学 习 , 接 下 来 可 以 利用 平衡 移动 机 器 人 完成 更 为 综合 的 应 用 。 


CHAPTER 7 


7.1 平衡 控制 一 一 直立 环 


7.1.1 平衡 控制 原理 


根据 第 4 章 的 内 容 可 知 , 智 能 平衡 移动 机 器 人 的 平衡 控制 原理 如 下 所 述 。 
。 要 有 回复 力 , 使 得 模型 可 以 到 达 平衡 位 置 。 
。 要 有 阻尼 力 ,使 得 模型 可 以 更 快 地 到 达 平衡 位 置 。 
根据 上 面 两 个 条 件 ,可 以 搭建 如 式 (7.1) 所 示 的 数学 模型 。 
a —k,0 + k,0' (7. 1) 
式 中 ,a 代表 加 速度 ,A; 代表 控制 器 的 回复 力 系 数 (&; Dg e 为 重力 加 速度 ),k, 代表 控制 
器 的 阻尼 力 系数 (&，, 二 0) 。 因 此 ,可 以 从 理论 上 说 


设 定 值 
明 平衡 移动 机 器 人 的 平衡 控制 是 可 以 通过 搭建 上 的 
述 的 数学 模型 实现 的 。 | 与 角速度 反馈 


数学 模型 的 控制 框图 如 图 7. 1 所 示 。 图 7.1 平衡 移动 机 器 人 控制 框图 
7.1.2 平衡 控制 模型 


本 书 重点 在 于 介绍 基于 MATLAB/Simulink 的 模型 开发 方法 ,因此 本 节 将 以 智能 平衡 
移动 机 器 人 的 平衡 控制 为 例 介绍 这 种 开发 方法 ,平衡 控制 模型 如 图 7. 2 所 示 。 

陀螺 仪 加 速度 计 传 感 器 MPU6050 获取 平衡 移动 机 器 人 的 角度 信号 Angle Balance, *F- 
衡 移 动机 器 人 的 角速度 信号 Gyro_Balance, 通 过 IIC 接口 输出 3 个 方向 的 信号 ,在 本 例 中 输 
th X 轴 角 速度 信号 和 车 身 绕 X 轴 的 角度 信号 作为 直立 环 平衡 控制 器 的 输入 ,经 过 平衡 控 
制 器 后 的 输出 信号 控制 智能 平衡 移动 机 器 人 两 轮 电 动机 ， 控制 电动 机 的 平衡 。 下 面具 体 介 
绍 各 个 环节 的 作用 。 

1. MPU6050 数据 输出 模块 

打开 MPU6050 数据 输出 模块 子 系统 ,如 图 7. 3 所 示 。 
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平衡 车 控制 系统 一 平衡 控制 


Note: TMS320F28069,TB6612,MPU6050 


XX 轴 角 速度 车 身 角 度 。 ”2Z 负 角速度 。 按键 标志 位 


平衡 车 控制 系统 初始 化 it 算 电 动机 控制 量 输出 PWM 到 电动 机 
MPU6050 数 据 输 出 直立 环 PD 控 制 | 
Xf pr 


倾角 保护 标志 


inus LED 闪 烁 指示 
图 7.2 平衡 控制 模型 


得 到 角度 、 角 速度 


读 取 MPU6050 数 据 


Gyro Tum 
判断 倾角 保护 标志 
-一 一 - ——* 
Key. Flag Key. Flag oro Tum 
$ 
Kcy Flag 


Read EncoderR 


图 7.3 MPU6050 数据 输出 模块 子 系统 
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通过 MPU6050_Read() 模 块 ,实时 读 取 平衡 移动 机 器 人 的 角度 .角速度 信和 号 ,再 通过 图 
中 的 Gyro_Balance 模块 .Angle_Balance 模块 将 两 信号 输出 作为 直立 环 PD 控制 器 的 输入 。 

2. 直立 环 PD 控制 模块 

打开 直立 环 PD 控制 模块 子 系统 ,如 图 7. 4 所 示 。 


Tum Off 


图 7.4 PD 控制 模块 子 系统 


MPU6050_Read() 模 块 的 平衡 移动 机 器 人 角度 信号 Angle_Balance、 角 速度 信号 Gyro_ 
Balance 作为 直立 环 PD 控制 的 输入 信和 号 ,在 本 模块 中 选择 — 72h, —0. 24, 是 符合 平衡 
控制 条 件 的 回复 力 系 数 和 阻尼 力 系数 , 且 该 控制 模型 完全 符合 设计 的 数学 模型 ,最 后 的 控制 
信号 以 int16 型 数据 输出 。 除 此 之 外 ,该 系统 引入 标志 位 ,是 为 了 防止 角度 偏差 过 大 而 设置 
保护 标志 位 ,如 图 7.5 所 示 , 其 值 设置 为 15 ,意味 着 当 实 际 的 角度 偏差 大 于 15" 时 ,该 标志 位 
就 会 产生 作用 。 


图 7.5 标志 位 原理 图 


3. 计算 电动 机 控制 量 模块 
打开 计算 电动 机 控制 量 模块 子 系统 ,如 图 7.6 所 示 。 


or 
注意 数据 类 型 
图 7.6 电动 机 控制 量 模块 子 系统 
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来 自 直 立 环 PD 的 控制 信号 作为 该 模块 的 输入 , 先 经 过 一 个 饱和 模块 ,将 转速 限制 为 
一 2000 一 2000 ,再 通过 Motor _ PWM, 如果 Motor>0, 则 此 时 有 PWMA — 2000. PWMB- 2000 — 
myabs(Motor); 反之 , 则 有 PWMB-— 2000, PWMA = 2000 — myabs (Motor) ,再 将 两 值 作为 
一 个 维 数 为 2 的 行 向 量 以 uint16 型 数据 输出 PWM 到 电动 机 模块 ,对 电动 机 进行 控制 。 

4. 输出 PWM 到 电动 机 模块 

打开 输出 PWM 到 电动 机 模块 子 系统 ,如 图 7.7 所 示 。 


图 7.7 电动 机 模块 子 系统 


Key Flag 是 MPU6050 数据 输出 模块 的 判断 倾角 保护 标志 ,和 直立 环 PD 控制 模块 的 
第 二 个 输出 flagIn 通过 一 个 与 门 对 电动 机 进行 控制 , 当 两 者 中 有 一 个 为 高 电 平 时 ,就 会 使 得 
电动 机 停 转 。 当 两 者 都 为 低 电 平 时 ,就 会 将 从 计算 电动 机 控制 量 模 块 得 到 的 电动 机 控制 信 
号 作为 输入 ,从 而 控制 智能 平衡 移动 机 器 人 两 轮 电动 机 的 工作 。 

5. 初始 化 模块 


打开 初始 化 模块 子 系统 ,如 图 7. 8 所 示 。 
* Init I2CA Initial OLED 
InitEQep!: Inif£Qep2GpioHD. POSSPEED init 
Init£QeptGpioHD. Inif£Qep2GpioHD 上 


图 7.8 初始 化 模块 子 系统 


初始 化 模块 的 作用 在 于 对 一 些 驱动 和 外 设 模块 进行 初始 化 操作 ,例如 ,设置 GPIO 的 输 
出 方向 .是 不 是 通用 GPIO 等 。 这 些 在 前 面 的 章节 中 都 有 介绍 ,读者 可 参考 前 面 的 内 容 。 

6. 记忆 功能 模块 

如 图 7. 9 所 示 , 对 于 从 MPU6050 中 获取 的 数据 ,记忆 功能 模块 会 将 Angle Balance, 
Gyro Balance,Gyro Turn,Key Flag 等 数据 存储 到 工作 空间 中 。 


， XH ff Ë JE 车 身 角 度 2Z 轴 角速度 按键 标志 位 


Gyro Balance Angle Balance 


图 7.9 记忆 功能 模块 
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7.1.3 平衡 控制 中 基于 模型 设计 与 自动 代码 生成 技术 


平衡 控制 中 基于 模型 设计 与 自动 代码 生成 的 具体 过 程 前 面 已 有 介绍 ,在 此 简单 回顾 一 
下 。 在 模型 中 打开 Configuration Parameters 参数 设置 对 话 框 ,在 Solver 解 算 器 中 设置 相 
关 参 数 ,在 Hardware Implementation 中 设置 芯片 类 型 等 相关 参数 ,在 Code Generation 中 
设置 Simulink Coder 等 相关 参数 。 有 具体 配置 过 程 见 图 7. 10 一 图 7.12. 


Ë Configuration Parameters: Balance Basic/Configuration (Active) 一 C 
Lt D NA MR c MM" 


@ Configuration Parameters: Balance Basic/Configuration (Active) 一 uú > 
[Q Search 


ln 
lt. 
图 7.11 硬件 配置 
BË Configuration Parameters: Balance Basic/Configuration (Active) 
信和 
_ im 


Zip fie name: «émply» ^. 7. 


图 7.12 系统 .tlc 文 件 


参数 配置 完 后 ,启动 模型 编译 ,进行 相关 处 理 后 将 编译 好 的 代码 烧 入 TMS320F28069 
芯片 中 ,从 而 实现 对 平衡 移动 机 器 人 的 直立 环 平衡 控制 。 
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7.1.4 平衡 控制 应 用 现象 
图 7. 13 所 示 为 智能 平衡 移动 机 器 人 的 平衡 控制 现象 。 


图 7.13 平衡 控制 应 用 图 


当 向 前 倾斜 平衡 移动 机 器 人 时 ,车 轮 会 加 速 往 前 转动 ; 当 向 后 倾斜 平衡 移动 机 器 人 时 ， 
车 轮 会 加 速 向 后 转动 。 当 尽量 水 平 放置 平衡 移动 机 器 人 时 ,车 轮转 速 很 慢 , 说 明 足 以 实现 平 
衡 移动 机 器 人 的 平衡 控制 。 


7.2 平衡 控制 一 一 速度 环 


7.2.1 应 用 原理 


i TELS E 车 模 不 同 的 倾角 会 引起 车 模 的 加 减速 ,从 
而 达到 对 于 速度 的 控制 。 实 际 上 ,最 后 还 是 演变 成 通过 控制 电动 机 的 转速 来 实现 车 轮 速 度 
的 控制 。 
。 当 需 要 提高 平衡 移动 机 器 人 向 前 的 行驶 速度 时 ,就 需要 增加 平衡 移动 机 器 人 的 倾 
角 ,倾角 增 大 后 ,车 轮 在 直立 控制 作用 下 需要 向 前 运动 保持 平衡 移动 机 器 人 平衡 , 速 
EN. 

。 当 需 要 降低 平衡 移动 机 器 人 向 前 行驶 速度 ,就 需要 减 小 平衡 移动 机 器 人 的 倾角 , 倾 
Sisi 以 后 ,车 轮 在 直立 控制 作用 下 运行 速度 减 小 ,以 保持 平衡 移动 机 器 人 的 平衡 。 

由 上 述 可 知 , 可 搭建 数学 模型 如 式 (7. 2) 和 式 (7. 3) 所 示 。 

a =k (8 —r,) + k,0 (7.2) 
rı =ksie(k) ha D yeh) (7.3) 
式 中 ,9 代表 角度 ,9 代表 角速度 ,elk) 是 实际 速度 与 设 定 速度 的 偏差 , e OO 偏差 求 和 代 
表 积 分 。 因 此 ,可 以 从 理论 上 说 明 平衡 移动 机 器 人 的 速度 控制 可 以 通过 搭建 上 述 数学 模型 
KEM. : 
数学 模型 的 控制 框图 如 图 7. 14 所 示 。 
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陀螺 仪 信息 
轮 式 机 器 人 
图 7.14 速度 控制 数学 模型 


7.2.2 速度 控制 模型 


本 书 重点 在 于 介绍 基于 MATLAB/Simulink 的 模型 开发 方法 ,因此 本 节 将 以 智能 平衡 
移动 机 器 人 的 速度 控制 为 例 介 绍 这 种 开发 方法 ,速度 控制 模型 如 图 7. 15 所 示 。 


平衡 车 控制 系统 一 一 速度 环 


Note: TMS320F28069,TB6612,MPU6050 


编码 器 信息 


EN ——— — 


系统 初始 化 


o - 


FÉ 7.15 ”速度 控制 模型 


陀螺 仪 加 速度 计 传 感 器 MPU6050 获取 平衡 移动 机 器 人 的 角度 信号 Angle Balance, 
衡 移动 机 器 人 的 角速度 信号 Gyro_Balance, 在 本 例 中 ,输出 X 轴 角 速度 信号 和 车 身 绕 
X 轴 的 角度 信号 作为 直立 环 平衡 控制 器 的 输入 ,同时 ,平衡 移动 机 器 人 左右 轮 上 的 编码 器 
获取 实际 的 速度 作为 速度 环 平衡 控制 器 的 输入 ,经 过 两 个 平衡 控制 器 后 的 输出 信号 
(Balance_Pwm 十 Velocity_Pwm) 秋 加 ,从 而 控制 智能 平衡 移动 机 器 人 两 轮 电 动机 ,控制 电 
动机 的 平衡 和 速度 。 由 于 有 关 平 衡 控 制 的 模型 在 7. 1 节 中 有 详细 的 介绍 ,下 面具 体 介 绍 其 
余 各 个 环节 的 作用 。 
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xs 


1. MPU6050 数据 输出 模块 
打开 MPU6050 数据 输出 模块 子 系统 ,如 图 7. 16 所 示 。 


Key_Flag 


图 7.16 输出 模块 子 系统 


编码 器 可 以 实时 采集 平衡 移动 机 器 人 的 速度 ,作为 MPU6050 数据 输出 模块 的 输出 ,会 
输入 到 速度 环 PI 控制 中 去 。 

2. 速度 环 平衡 控制 模块 

打开 速度 环 平衡 控制 模块 子 系统 ,如 图 7. 17 Bron 


图 7.17 速度 环 平衡 控制 模块 子 系统 
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编码 器 采集 实际 速度 和 给 定 速度 的 偏差 经 过 低 通 滤波 器 处 理 , 然 后 分 两 路 : 一 路 向 下 ， 
进行 P 控 制 , 此 处 KP1—46; 另 一 路 经 过 离散 积分 进行 D 控制 (当中 断 标志 位 偏差 超过 40 
时 ,会 将 积分 清 零 ), 两 路 控制 信号 全 加 ,以 int16 型 数据 输出 。 

3. 计算 电动 机 控制 量 模 块 

打开 计算 电动 机 控制 量 模块 子 系统 ,如 图 7. 18 所 示 。 


图 7.18 电动 机 控制 量 模块 子 系统 


来 自 直 立 环 PD(Balance_Pwm) 和 速度 环 PI(Velocity_Pwm) 的 控制 信号 作为 该 模块 
的 输入 , 先 经 过 一 个 饱和 模块 ,将 转速 限制 在 一 2000 一 2000, 再 通过 Motor_PWM ,如 果 
Motor>>0, 则 此 PWMA = 2000, PWMB = 2000 — myabs( Motor); X Z .PWMB- 2000. 
PWMA —2000— myabs(Motor) ,再 将 两 值 作为 一 个 维 数 为 2 的 行 向 量 以 uint16 型 数据 输 
出 PWM 到 电动 机 模块 ,对 电动 机 进行 控制 。 

4. 输出 PWM 到 电动 机 模块 

打开 输出 PWM 到 电动 机 模块 子 系统 ,如 图 7.19 所 示 。 


图 7.19 电动 机 模块 子 系统 


Key_Flag 是 MPU6050 数据 输出 模块 的 判断 倾角 保护 标志 ,和 直立 环 PD 控制 模块 的 
第 二 个 输出 flagIn 通过 一 个 与 门 对 电动 机 进行 控制 , 当 两 者 中 有 一 个 为 高 电 平时 ,就 会 使 得 
电动 机 停 转 。 当 两 者 都 为 低 电 平时 ,就 会 将 从 计算 电动 机 控制 量 模块 得 到 的 电动 机 控制 信 
号 作为 输入 ,从 而 控制 智能 平衡 移动 机 器 人 两 轮 电动 机 的 工作 。 
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7.2.3 速度 控制 应 用 现象 


速度 控制 中 基于 模型 设计 与 自动 代码 生成 的 具体 过 程 与 7. 1. 3 节 类 似 , 此 处 不 再 赣 述 。 
如 图 7. 20 所 示 ,为 智能 平衡 移动 机 器 人 速度 控制 的 应 用 现象 ,将 平衡 移动 机 器 人 放 在 
水 平 桌面 上 ,上 电 , 会 发 现 平衡 移动 机 器 人 基本 稳定 在 一 个 位 置 。 


图 7.20 速度 控制 应 用 图 


7.3 APP 控制 


7.3.1 应 用 原理 


APP 是 以 平衡 控制 进 阶 应 用 为 基础 ,利用 不 同 的 通信 模块 来 实现 与 平衡 移动 机 器 人 无 
线 通 信 。 本 应 用 可 以 支持 基于 CC2541 芯片 的 蓝牙 模块 .型 号 为 ATK-ESP8266 的 WiFi 模 
块 .EC200T 系列 的 4G 通信 模块 ,这 3 种 方式 都 可 以 通过 手机 APP 或 者 计算 机 端 软件 对 平 
衡 移 动机 器 人 进行 平衡 控制 ,而 无 须 额 外 的 串口 线 ,避免 了 烦琐 的 线 缆 连接 。 如 图 7.21 所 
RA 3 种 通信 模块 实物 图 。 


”人 
RA fone 


(a) 蓝牙 模块 ` (b) WiFi (c) 4G 通 信 模块 
图 7.21 通信 模块 实物 图 
。 平衡 移动 机 器 人 速度 : 通过 调节 平衡 移动 机 器 人 的 倾角 来 实现 平衡 移动 机 器 人 速 
度 控 制 。 
。 控制 平衡 移动 机 器 人 方向 : 通过 控制 两 个 电动 机 之 间 的 转动 差 速 实现 平衡 移动 机 
器 人 转向 控制 。 
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7.3.2 APP 控制 模型 


本 书 重点 在 于 介绍 基于 MATLAB/Simulink 的 模型 开发 方法 ,因此 本 节 将 以 智能 平衡 
移动 机 器 人 的 APP 控制 为 例 介绍 这 种 开发 方法 。 模 型 如 图 7. 22 所 示 。 


平衡 车 控制 系统 一 -APP 控制 


Note: TMS320F28069, TB6612, MPU6050 


图 7.22 APP 控制 模型 


陀螺 仪 加 速度 计 传 感 器 MPU6050 获取 平衡 移动 机 器 人 的 角度 信号 Angle_Balance\ 平 
衡 移 动机 器 人 的 角速度 信号 Gyro_Balance, 平 衡 移 动机 器 人 X 轴 角 速度 信号 和 车 身 绕 X 
轴 的 角度 信号 作为 直立 环 平衡 控制 器 的 输入 ,经 过 平衡 控制 器 后 的 输出 信号 控制 智能 平衡 
移动 机 器 人 两 轮 电动 机 ,控制 电动 机 的 平衡 。 

平衡 移动 机 器 人 左右 轮 上 的 编码 器 获取 实际 的 速度 作为 速度 环 平衡 控制 器 的 输入 , 同 
时 加 上 从 串口 发 来 的 Flag_qian、Flag_hou 作为 输入 控制 平衡 移动 机 器 人 的 速度 。Flag_ 
qian,Flag hou,Flag left,Flag right 作为 转向 环 输入 信号 ,经 过 PD 控制 后 控制 平衡 移动 
机 器 人 的 转向 。 

下 面具 体 介 绍 7.1 节 和 7. 2 节 未 介绍 到 的 其 余 模 块 。 

1. MPU6050 数据 输出 模块 

打开 MPU6050 数据 输出 模块 子 系统 ,如 图 7. 23 所 示 。 

从 MPU6050 数据 输出 模块 中 可 以 获取 平衡 移动 机 器 人 绕 Z 轴 的 角度 信号 Gyro _ 
Turn, 作 为 转向 环 PD 控制 的 输入 。 
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图 7.23 MPU6050 数据 输出 模块 子 系统 


2. APP 控制 信号 输入 模块 
打开 APP 控制 信号 输入 模块 子 系统 ,如 图 7. 24 所 示 。 


图 7.24 信号 输入 模块 子 系统 


通过 串口 接收 外 部 中 断 信号 ,随后 将 Flag_qian、Flag_hou 作为 速度 环 PI 控制 的 输入 ， 
对 平衡 移动 机 器 人 速度 产生 作用 。Flag_qian、Flag_hou、Flag_left、Flag_right 作为 转向 环 
PD 控制 的 输入 对 平衡 移动 机 器 人 转向 产生 作用 。 

3. 速度 环 平衡 控制 模块 

打开 速度 环 平衡 控制 模块 子 系统 ,如 图 7. 25 所 示 。 

与 7. 2 节 中 提 到 的 速度 环 平衡 控制 模块 相 比 ,APP 控制 中 的 速度 环 平衡 控制 模块 在 原 
来 基础 上 加 入 了 Flag qian,Flag hou 信号 ,从 而 实现 手机 对 平衡 移动 机 器 人 的 速度 控制 。 

4. 转向 环 平衡 控制 

打开 转向 环 平衡 控制 模块 子 系统 ,如 图 7. 26 所 示 。 
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7.26 转向 环 平衡 控制 模块 子 系统 


转向 环 平衡 控制 对 Flag left,Flag right 信号 进行 条 件 判 断 ,进行 P 控制, 和 Flag_qian、 
Flag hou 和 Gyro Turn 进行 到 加 以 int16 型 数据 输出 ,从 而 对 平衡 移动 机 器 人 的 转向 进行 控制 。 

如 图 7. 27 所 示 ,对 于 从 MPU6050 和 APP 中 获取 的 数据 ,记忆 功能 模块 会 将 Angle 
Balance,Gyro. Banlace.Gyro. Turn .Key Flag,Flag qian,Flag hou,Flag left,Flag right 
等 数据 存储 进 工作 空间 中 以 备 随时 调用 。 
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图 7.27 记忆 功能 模块 


初始 化 模块 .计算 电动 机 控制 量 模块 .输出 PWM 到 电动 机 模块 在 7. 1 节 中 已 经 介绍 完 
毕 , 此 处 不 再 缆 述 。 
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7.3.3 APP 控制 应 用 现象 


APP 控制 中 基于 模型 设计 与 自动 代码 生成 的 具体 过 程 与 7.1. 3 节 类 似 ,此 处 不 再 缆 述 。 
图 7. 28 所 示 为 智能 平衡 移动 机 器 人 APP 控制 的 应 用 现象 。 


图 7.28 平衡 移动 机 器 人 APP 控制 应 用 


对 平衡 移动 机 器 人 进行 应 用 控制 ,操作 方式 如 下 : 

。 单 击 APP 前 进 区 域 ,平衡 移动 机 器 人 向 前 运动 。 
。 单 击 APP 后 退 区 域 ,平衡 移动 机 器 人 向 后 运动 。 
。 单 击 APP 左 转 区 域 , 平 衡 移动 机 器 人 向 左 运动 。 
* fi; APP 右 转 区 域 , 平 衡 移动 机 器 人 问 右 运动 。 
。 不 单 击 任何 区 域 , 平 衡 移 动机 器 人 停止 运动 。 


7.4 红外 循 迹 应 用 


7.4.1 模块 介绍 


如 图 7. 29 所 示 是 套件 中 的 红外 循 迹 模块 ,该 模块 是 为 智能 平衡 移动 机 器 人 、 机 器 人 等 
自动 化 机 械 装置 提供 一 种 多 用 途 的 红外 线 探测 系统 的 解决 方案 。 


图 7.29 ”红外 循 迹 模块 
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该 传感器 模块 对 环境 光线 适应 能 力 强 , 其 具有 一 对 红外 线 发 射 与 接收 管 ,发 射 管 发 射出 
一 定 频率 的 红外 线 , 当 检测 方向 遇 到 障碍 物 ( 反 射 面 ) 时 ,红外 线 反 射 回来 被 接收 管 接 收 ,经 
过 比较 器 电路 处 理 之 后 ,同时 信号 输出 接口 输出 数字 信号 (一 个 低 电 平 信 号 ) ,可 通过 电位 器 
旋钮 调节 检测 距离 ,有效 距离 范围 2 一 60cm ,工作 电压 为 3.3 一 5V。 I 

该 传感器 的 探测 距离 可 以 通过 电位 器 调节 .具有 干扰 小 、 便 于 装配 ,使 用 方便 等 特点 ,可 
以 广泛 应 用 于 机 器 人 避 障 、 避 障 平衡 移动 机 器 人 ,流水线 计数 及 黑白 线 循 迹 等 众多 场合 。 

模块 安装 效果 如 图 7. 30 所 示 。 


图 7.30 ”红外 循 迹 模块 安装 效果 图 


7.4.2 使 用 原理 


当 模 块 检测 到 前 方 障碍 物 信号 时 ,电路 板 上 红色 指示 灯 点 亮 , 同 时 OUT 端口 持续 输出 
低 电 平 信 号 ,该 模块 检测 距离 为 2 一 60cm ,检测 角度 为 35" ,检测 距离 可 以 通过 电位 器 进行 调 
节 , 顺 时 针 调 电位 器 ,检测 距离 增加 ; 逆 时 针 调 电位 器 ,检测 距离 减少 。 

传感器 属于 红外 线 反射 探测 ,因此 目标 反射 率 和 形状 是 探测 距离 的 关键 。 其 中 黑色 探 
测 距 离 最 小 ,白色 最 大 ; 小 面积 物体 距离 小 ,大 面积 物体 距离 大 。 传 感 器 模块 输出 端口 
OUT 可 直接 与 单片机 I/O 口 连接 即 可 ,也 可 以 直接 驱动 一 个 5V 继电器 模块 或 者 蜂 鸣 器 
模块 连接 方式 : VCC-VCC; GND-GND; OUT-IO。 

比较 器 采用 TI 公司 的 LM339 ,工作 稳定 。 模 块 电位 器 在 出 厂 前 已 经 根据 安装 位 置 调 
整 好 ,但 用 户 需要 根据 环境 光亮 进行 微调 ,调节 标准 为 黑 线 在 探头 正 下 方 时 , 蓝 色 LED YT 
灭 , 移 开 时 蓝 色 LED 灯亮 。 

如 图 7. 31 所 示 为 调节 方式 。 按 照 要 求 将 探头 与 红外 中 控 板 连接 好 , 移 开 探头 前 面 所 有 
物体 , 且 探 头 不 要 指向 有 阳光 的 地 方 ( 光 线 对 探头 有 较 大 于 扰 ) ,调节 每 一 路 的 电位 器 ,直到 
灯 刚 好 灭 掉 , 然 后 探头 移 向 白 纸 空白 处 ,会 发 现 蓝 色 LED 灯会 点 亮 ,这 样 就 算 测 试 成 功 了 ， 
然后 我 们 就 可 以 将 中 控 板 的 输出 信号 传人 主 控 板 进行 高 低 电 平 检测 了 。 

LM339 的 工作 原理 如 图 7. 32 所 示 ,我 们 以 第 一 路 指示 灯 来 简单 说 明 一 下 : IN1 一 为 
定位 器 调节 的 电压 输入 端 ,IN 十 为 探头 输出 的 电压 (就 是 探头 OUT 与 GND 的 电压 ) , ` 
IN1 一 电压 之 IN1 十 电压 时 ,对 应 的 OUI 输出 的 电 平 电压 接近 0V, 此 时 ,对 应 的 LED 灯会 
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TO 


图 7.31 


红外 循 迹 模 块 调试 


亮 ; 当 IN1 一 电压 过 IN1 十 电压 时 ,对 应 的 OUI 输出 的 电 平 电压 接近 5V, 此 时 对 应 的 LED 
灯会 点 亮 , 此 处 也 即 整 个 电路 工作 的 核心 。 根 据 这 个 原理 ,就 可 以 简单 地 进行 一 个 测试 了 ， 
调节 第 一 路 的 电位 器 ,使 IN 一 的 电压 为 2, 5V 左右 ,然后 分 别 对 INT 接 0V 和 5V 电压 ,可 
以 发 现 , 接 0V 时 ,LED 灯亮 ; 接 5V 时 ,LED 灯 灭 。 联 机 测试 : 按照 要 求 将 探头 与 中 控 板 连 
接 好 , 移 开 探头 前 面 所 有 物体 , 且 探 头 不 要 指向 有 阳光 的 地 方 ( 光 线 对 探头 有 较 大 干扰 ) , 调 
节 每 一 路 的 电位 器 ,直到 灯 刚 灭 掉 , 然 后 用 白 纸 中 挡 探 头 ,会 发 现 LED 灯会 点 亮 ,这 样 就 算 


三 
Ju s 


测试 成 功 了 。 


实际 测试 如 图 7.33 所 示 。 


图 7.32 


然后 我 们 就 可 以 将 中 控 板 的 输出 信号 传人 单片机 进行 高 低 电 平 检测 了 。 
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控制 原理 图 


图 7.33 


实际 测试 
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7.4.3 模型 搭建 
完整 控制 框图 如 图 7.34 所 示 。 


平衡 车 控制 系统 一 -红外 循 迹 


Note: TMS320F28069, TB6612, MPU6050 
系统 初始 化 


图 7.34 完整 控制 框图 


程序 设计 思路 如 下 所 述 。 

首先 设置 系统 时 钟 为 80MHz,Timer0 为 5ms 执行 一 次 中 断 ,接着 初始 化 本 次 实验 需要 
的 各 个 模块 ,包含 按键 的 GPIO 模块 .EQepl 和 EQep2 模块 IIC 模块 以 及 MPU6050 模块 ， 
红外 探头 传感器 GPIO 的 初始 化 ,然后 完成 传感器 数据 采集 ,最 后 根据 采集 到 数据 完成 
控制 。 

(1) 模块 初始 化 如 图 7. 35 所 示 。 


(2) 全 局 变量 定义 如 图 7. 36 所 示 。 
初始 化 好 九 个 全 局 变量 ,Gyro_Balance 表示 陀螺 仪 x 的 角速度 的 值 , Angle_Balance 表 
示 车 身 相 对 于 Z 轴 的 角度 ,Gyro_Turn 表示 陀螺 仪 z 的 角速度 的 值 ,Key_Flag 表示 按键 电 


平 检测 标志 值 ,Flag_qian、Flag_hou、Flag_left、 Flag_right 分 别 为 前 、 后 、 左 , 右 标 志 位 , Dir 
表示 方向 偏转 标志 。 š 


图 7.36 全 局 变量 定义 
(3) 传感器 数据 采集 如 图 7. 37 所 示 。 


此 模块 用 作 得 到 MPU6050 的 原始 数据 。 


Gyro, Tum 
[BALA t pri 
¿qua El ina OW OR 


Jte. 左 偏 
ARNA ==0&&RN1 =I &&RIN2—-1) 


lU 先入 检测 到 黑 线 ， ihi 


E 7.37 传感器 数据 采集 


(4) 直立 环 PD 控制 模块 如 图 7. 38 所 示 。 

由 于 红外 循 迹 模块 的 安装 导致 平衡 移动 机 器 人 的 平衡 位 置 发 生 改变 ,经 调试 当 平 衡 移 
动机 器 人 的 中 值 角度 在 3" 左 右 , 所 以 将 直立 环 的 ZHONGZHI 设 为 3。 

(5) 速度 环 控制 模块 如 图 7. 39 所 示 。 f 

速度 环 给 定 一 个 前 进 的 速度 ,即将 Movement 设 为 小 于 0 的 数 , 这 里 设 为 一 7。 

(6) 红外 循 迹 算 法 模块 如 图 7. 40 所 示 。 

根据 Dir 值 给 定 转向 值 : 

* Dir 1 表示 平衡 移动 机 器 人 相对 黑 线 右 偏 ,给 一 个 向 左 转 的 量 。 

* Dir=2 表示 平衡 移动 机 器 人 相对 黑 线 左 偏 , 给 一 个 向 右 转 的 量 。 

* Dir=0 直行 。 
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Balance Pwm-Balance(Angle Balance, Gyro_Balance); 


" Tumoff Flag 
Tum Off 
m r4 Outi 
To Conatant. 


图 7,38 直立 环 控制 


Velocity Pwmz-Velocity(Encoder Left, Encoder Right); 


Ed 7.40 红外 循 迹 算法 搭建 
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7.5 本 章 小 结 


本 章 主要 介绍 了 智能 平衡 移动 机 器 人 的 综合 实验 ,包括 平衡 控制 .APP 控制 . 避 障 / 跟 
随 、 红 外 循 迹 及 MATLAB/Simulink 的 仿真 实验 ,结合 平衡 控制 原理 及 红外 循 迹 模块 的 工 
作 原 理 , 利 用 Simulink 进行 仿真 模型 搭建 。 
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刘志峰 合肥 工业 大 学 副 校长 ， 教 育 部 高 等 学 校 机 械 类 专业 教学 指导 委员 会 委员 

理论 与 实践 的 结合 、 科 研 与 教学 的 贯穿 ， 是 对 工科 教师 把 一 门 课程 讲 深 、 讲 透 的 基本 要 求 。 本 书 作者 根据 自己 多 
年 的 学 习 及 研究 经 验 ， 系 统 全 面 地 介绍 了 智能 平衡 移动 机 器 人 的 应 用 平台 搭建 、 平 台 的 硬件 电路 、 数 字 控 制 系统 
和 一 系列 开发 移动 机 器 人 的 应 用 ， 不 仅 重 点 介绍 了 基于 模型 设计 的 开发 方法 ， 而 且 给 出 了 移动 机 器 人 平台 硬件 、 
软件 的 选 型 等 综合 知识 ， 既 可 以 快捷 地 实现 基础 应 用 、 进 阶 应 用 和 综合 应 用 的 知识 学 习 ， 又 可 以 很 好 地 指导 实践 
与 应 用 。 


机 电 一 体 化 技术 ， 不 失 为 一 个 “工程 教育 的 典型 案例 ”; 同时 ， 它 也 为 自动 化 类 、 电 和 气 类 与 机 械 类 本 科 专 业 “ 复 
杂工 程 问题 的 教学 设计 ”提供 了 一 个 很 好 的 解决 方案 。《 智 能 平衡 移动 机 器 人 》 一 书 的 创作 者 们 精心 编排 了 机 器 
人 “从 功能 原件 到 系统 组 成 、 从 理论 算法 到 软件 编制 、 从 物理 模型 到 数学 建 模 ”的 开发 思想 与 设计 过 程 ， 其 中 也 
蕴 合 了 移动 机 器 人 “系统 集成 技术 ”的 精 吸 。 


Ye-Hwa Chen 美国 佐治 亚 理 工学 院 终身 教授 

本 书 融合 了 单片机 、C 语 言 、 电 机 、 传 感 器 、 建 模仿 真 、 视 觉 等 一 系列 技术 ， 很 好 地 将 学 生 之 前 所 学 的 知识 进行 
融会 贯通 。 基 于 智能 平衡 移动 机 器 人 这 样 的 平台 ， 学 生 可 以 软 硬 结合 、 理 论 与 实践 结合 并 快速 上 手 解决 实际 问 
题 ， 进 而 提升 综合 开发 能 力 。 采 用 基于 模型 设计 方法 和 MATLAB/Simulink 工 具 ， 学 生 在 学 习 与 动手 过 程 中 可 逐 
步 提高 创新 能 力 和 解决 复杂 工程 问题 的 能 力 ， 真 正 做 到 将 理论 应 用 于 实践 之 中 。 


董 淑 成 MathWorks 公 司 基于 模型 设计 专家 

这 是 一 本 实践 性 很 强 的 图 书 ， 有 助 于 激发 学 生 的 学 习 热情 ， 从 实践 中 巩固 理论 知识 。 基 于 模型 设计 作为 本 书 着 重 
介绍 的 软件 开发 模式 ， 在 工业 界 有 着 非常 广泛 的 应 用 ， 可 以 让 开发 人 员 从 繁重 的 编码 工作 中 解脱 出 来 ， 将 更 多 的 
精力 投入 到 更 有 价值 的 设计 工作 。 对 于 在 校 学 生来 讲 ， 尽 早 地 接触 工业 界 的 开发 模式 有 助 于 培养 学 生 的 工程 师 思 
维 ， 为 今后 成 长 为 优秀 的 工程 设计 人 员 打 下 良好 的 基础 。 
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